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(57) The present invention relates to a method of 
controlling a numerically controlled machine tool having 
a plurality of feed shafts. Also, the present invention re- 
lates to a numerically controlled machine tool. Accord- 
ing to the present invention, it is possible to solve con- 
ventional problems so as to realize highly accurate ma- 
chining even when a moving body of the machine is 



moved at high speed. As the means for solving the prob- 
lems, an appropriate command corresponding to a fric- 
tional force of the feed mechanism of the numerically 
controlled machine tool and also corresponding to a 
change in the weight of a workpiece is estimated by cal- 
culation, and the thus estimated command is outputted 
into the drive unit of the feed shaft motor so as to drive 
the feed shaft motor. 
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Description 

TECHNICAL FIELD OF THE INVENTION 

[0001] The present invention relates to a method of 
controlling a numerically controlled machine tool such 
as a milling machine, machining center or electric dis- 
charge machine having a plurality of feed shafts of three 
orthogonal axes of X, Y and Z or having a plurality of 
feed shafts of at least one of the rotary shafts of axes of 
A, B and C in addition to the three orthogonal axes of X, 
Y and Z. Further, the present invention relates to a nu- 
merically controlled machine tool. In other words, the 
present invention relates to a new technique of a numer- 
ically controlled machine tool by which a workpiece can 
be machined with high accuracy even at a high feed 
speed. 

DESCRIPTION OF THE PRIOR ART 

[0002] Concerning a numerically controlled machine 
tool, it is required that a workpiece is accurately ma- 
chined in a short period, that is, it is required that a work- 
piece is highly efficiently and accurately machined. In 
general, it is known that machining accuracy is deterio- 
rated when the feed speed of a machine tool is raised. 
This deterioration in machining accuracy is caused by 
a lost motion of the feed shaft and a delay of servo-con- 
trol of the numerically controlled machine tool. There- 
fore, in the case of a numerically controlled machine 
tool, in order to conduct machining with high accuracy 
even when the feed speed is raised to a high value, 
backlash of the feed shaft is corrected and further fric- 
tion of the feed shaft is corrected, and furthermore 
speed adjusting control of the feed shaft is conducted 
according to the weight of a workpiece and the temper- 
ature of the feed shaft motor. For example, the following 
prior arts are provided. 

[0003] The first prior art is disclosed in Japanese Pat- 
ent Publication No. 2606773, which discloses an accel- 
eration control method and device in a servo system. 
According to this prior art, lost motions of the feed shaft 
caused by backlash, elastic deformation and static fric- 
tion in the case of inversion in the direction of movement 
of the feed shaft are corrected by conducting the most 
appropriate acceleration control corresponding to the 
respective characteristics so as to reduce the deteriora- 
tion of machining accuracy. To accomplish the above 
object, the first, second and third acceleration for com- 
pensating the lost motions caused by backlash, elastic 
deformation and static friction in the feed system are 
added to the speed commands of the servo control unit, 
so that the delay caused by the lost motions can be im- 
mediately made up. 

[0004] The second prior art is a servo motor control 
method disclosed in Japanese Patent Publication No. 
2709969. According to this method, for the object of con- 
ducting the most appropriate backlash correction even 
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when the cutting condition fluctuates, the target value is 
set at a value, the sign of which is reverse to that, of the 
integrator of the speed control unit before the direction 
of movement is inverted, and a value obtained when the 

5 value of the integrator of the speed control unit is sub- 
tracted from the target value is multiplied by a constant, 
and the thus obtained value is made to be a value of 
backlash acceleration in the speed control unit, for ex- 
ample, a value obtained when a value proportional to 

10 the square root of a positional deviation at the moment 
when the direction of movement is inverted is multiplied, 
and the thus obtained value is made to be a value of 
backlash acceleration in the speed control unit. 
[0005] The third prior art is a method and device of 

15 controlling acceleration and deceleration of a machine 
tool disclosed in Japanese Unexamined Patent Publi- 
cation No. 11-90769. According to this prior art, for the 
object of ensuring high machining accuracy and short- 
ening the machining time when the weights of moving 

20 things such as a tool and a workpiece are changed in 
the case of replacing them, the drive system is control- 
led by an acceleration corresponding to the rigidity of 
the machine tool, machining accuracy (allowable error) 
and weight of the workpiece. That is, there is disclosed 

25 a technique in which the acceleration is changed corre- 
sponding to the load inertia which has been previously 
set. 

[0006] The fourth prior art is a speed control unit of a 
servo motor disclosed in Japanese Unexamined Patent 

30 Publication No. 6-274763. This patent publication de- 
scribes a torque observer by which the load torque is 
estimated from the output torque of the feed shaft motor 
and the acceleration of an object to be driven. According 
to this technique, a change in the estimated value of the 

35 load torque is detected, and the load inertia is estimated, 
and then the load inertia which has been set in the 
torque observer is renewed. 

[0007] The fifth prior art is a method and device of con- 
trolling a numerically controlled device disclosed in Jap- 

40 anese Patent Publication No. 2853023. According to 
this technique, for the object of preventing the feed shaft 
motor from overheating even when the motor is contin- 
uously operated being frequently accelerated and de- 
celerated because the feed shaft is quickly rotated, the 

45 temperature of the feed shaft motor is measured, and 
the thus measured temperature is compared with the 
predetermined temperature data allowed to the feed 
shaft motor. According to the result of comparison, the 
acceleration and the deceleration curve of the feed shaft 

50 are controlled being changed. 

[0008] According to the first prior art, the acceleration 
is found, and the thus found acceleration is added to a 
speed command value of the servo control unit. In a nu- 
merically controlled machine tool, which is actually 

55 used, it is finally required that how high torque command 
value or how high electric current command value is out- 
putted to the feed shaft motor drive means. Therefore, 
when the speed command value in the middle of servo 
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control is changed like the first prior art, a delay is 
caused when the command value is converted into a 
torque command value or an electric current command 
value and arrives at the feed shaft motor drive means. 
[0009] According to the second prior art, the backlash 5 
acceleration calculated according to the positional de- 
viation is made to be a backlash acceleration in the 
speed control unit. Therefore, a delay still exists in the 
servo system composed of a positional feedback control 
means and speed feedback control means. 
[0010] According to the third prior art, the load inertia 
is previously set at a predetermined value. Therefore, 
the acceleration is changed according to the weight of 
a workpiece. That is, when the weight of a workpiece is 
heavy, the acceleration is raised to an allowable limit, 
and when the weight of a workpiece is light, the accel- 
eration is lowered. When the acceleration is lowered, 
the machining efficiency is deteriorated. 
[001 1] The fourth prior art relates to a torque observer 
for estimating the load torque of a common servo motor. 
The load torque is estimated according to the speed 
command value, and the load inertia is estimated ac- 
cording to the estimated load torque. Then, the estimat- 
ed load inertia is sent to the transfer function of the me- 
chanical system so as to conduct feed control. Accord- 
ing to the aforementioned technique, since the load in- 
ertia is an estimated value, a delay is caused in the feed 
shaft of the device, and the machining accuracy is af- 
fected by the delay. 

[0012] According to the fifth prior art, the time con- 
stant of acceleration and deceleration is controlled in ac- 
cordance with the temperature of the feed shaft motor, 
so that the feed shaft motor is prevented from overheat- 
ing without changing the command feed speed, when 
this technique is adopted, it is possible to prevent the 
feed shaft motor from overheating, however, the time 
constant of acceleration and deceleration is increased, 
and the machining accuracy is deteriorated. 
[0013] Other than the above prior arts, there are pro- 
vided conventional methods in which correction of back- 
lash or correction of friction is conducted. However, ac- 
cording to these conventional methods, the same cor- 
rection value is used without giving consideration to the 
speed and acceleration of a moving object. In the case 
of an actual machining operation, when an object of the 
same profile is machined at a different feed speed, the 
dimension of machining changes when the conventional 
correction is conducted. When a curved face, the radius 
of curvature of which is different, is machined over a plu- 
rality of quadrants, the feed speed of at least one feed 
shaft once becomes zero in the case of changing over 
the quadrant. After that, the direction of the feed speed 
is inverted. Therefore, an acceleration is generated. In 
this case, the acceleration is changed by the radius of 
curvature. When the conventional correcting method is 
applied to the aforementioned case, the machining size 
is changed. That is, in the case of inverting a direction 
of movement and also in the case of starting a move- 
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ment after a temporary stoppage, it is necessary to con- 
duct correction of friction according to the speed and ac- 
celeration of a moving object. 
[0014] Concerning the value of load inertia of the con- 
ventional numerically controlled device, for example, 
the value of load inertia in the case of loading a work- 
piece, the weight of which is half of the weight of a max- 
imum workpiece to be loaded, is adopted as a constant 
value. A value found when this constant value is multi- 
plied by the acceleration at each time is outputted to the 
feed motor drive means as a torque command. Under 
the above controlling condition, even if the load inertia 
is increased when a heavy work is loaded, it is impos- 
sible to generate a necessary torque command. There- 
fore, the actual movement of the feed shaft is delayed 
with respect to the movement command. Even if the 
load inertia is decreased when a light workpiece is load- 
ed, a torque command, which is unnecessarily high, is 
generated, so that the moving body is given a shock. As 
a result, the feed speed fluctuates, and machining can 
not be performed with accuracy and the thus obtained 
profile is deteriorated. Further, although the weight of a 
workpiece changes every second, that is, although the 
load inertia changes, the torque command is kept con- 
stant. In other words, servo control can not follow the 
load condition which changes every second. As a result, 
the machining accuracy is changed. 

SUMMARY OF THE INVENTION 

[001 5] The present invention has been accomplished 
to solve the above problems of the prior art. It is an object 
of the present invention to provide a method of control- 
ling a numerically controlled machine tool. Also, it is an 
object of the present invention to provide a numerically 
controlled machine tool capable of conducting machin- 
ing with high accuracy even if a moving object of the 
machine is moved at high speed. 
[0016] It is another object of the present invention to 
enhance the machining accuracy in the case of machin- 
ing a profile or a curved face by moving a plurality of 
feed shafts simultaneously. 

[0017] It is still another object of the present invention 
to conduct machining with high accuracy by giving con- 
sideration to a change in the dynamic frictional force and 
also a change in the static frictional force in the case of 
inverting a direction of movement of the feed shaft and 
also in the case of starting a movement from a stoppage. 
[0018] It is still another object of the present invention 
to conduct machining with high accuracy by giving con- 
sideration to a change in the weight when a workpiece 
loaded on the moving body of the feed shaft or an at- 
tachment is replaced or when a workpiece is machined 
so that the weight of the workpiece is reduced with time. 
[001 9] It is still another object of the present invention 
to conduct machining highly efficiently with high accu- 
racy without the occurrence of overheat of the feed shaft 
motor even if the feed shaft motor is continuously oper- 
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ated while it is frequently accelerated and decelerated. 
[0020] In order to accomplish the above objects, the 
present invention is composed as follows. By using the 
execution result of the numerically controlled program 
data obtained from the servo control unit of the numer- 
ically controlled device, a desired torque command or 
an electric current command, which corresponds to a 
change in the frictional force of the feed mechanism of 
the feed shaft or corresponds to a change in a work- 
piece, is estimated by calculation, and the thus obtained 
estimation value is outputted to the feed motor drive 
means. 

[0021] According to the present invention, there is 
provided a method of controlling a numerically control- 
led machine tool having a plurality of feed shafts of three 
orthogonal X-, Y-, and Z-axes of X or at least one of ro- 
tary shafts of A-, B- and C-axes in addition to a plurality 
of feed shafts of three orthogonal X-, Y-, and Z-axes of 
X, characterized in that the method comprises the steps 
of: 

taking numerical controlling program data from a 
reading and interpreting unit provided in a numeri- 
cally controlling device to execute the program data 
in a movement command distribution controlling 
unit and a servo control unit; 
estimating an appropriate torque or electric current 
command corresponding to the changes in frictional 
force in the feed mechanisms of the respective feed 
shafts or in the weight of a workpiece based on the 
results of execution of the numerically controlling 
program data outputted from the servo control unit; 
outputting the estimated appropriate torque or elec- 
tric current command to motor drive means of the 
feed shafts; and 

driving feed motors by the appropriate torque or 
electric current command corresponding to the 
changes in frictional force in the feed mechanisms 
of the respective feed shafts or in the weight of a 
workpiece. 

[0022] According to the present invention, there is 
provided a method of controlling a numerically control- 
led machine tool including the steps of taking numerical 
controlling program data from a reading and interpreting 
unit provided in a numerically controlling device to exe- 
cute the program data in a movement command distri- 
bution controlling unit and a servo control unit; and out- 
putting the execution to motor drive means of the feed 
shafts through feed shaft motor driving means to move 
a moving body by a feed mechanism, characterized in 
that the method comprises the steps of: 

calculating a torque or electric current command, 
based on a moving command value outputted from 
the movement command distribution controlling 
unit, in the servo control unit to output to the feed 
motor driving means to drive the feed motor; 



taking the torque or electric current command out- 
putted from the servo motor control unit to the feed 
shaft motor driving means; 
estimating a desired torque or electric current com- 

5 mand corresponding to the changes in frictional 
force in the feed mechanisms of the respective feed 
shafts or in the weight of a workpiece based on the 
results of execution of the numerically controlling 
program data outputted from the servo control unit; 

10 outputting the estimated desired torque or electric 
current command to motor drive means of the feed 
shafts; and 

[0023] Estimation of the desired torque or electric cur- 
15 rent command corresponding to the changes in frictional 
force in the feed mechanisms or in the weight of a work- 
piece is an estimation of a torque or electric current com- 
mand corresponding to the changes in frictional force in 
the feed mechanisms or in the weight of a workpiece 
20 based on the torque or electric current command and 
the acceleration of the feed shaft, which have been tak- 
en. 

[0024] Further, according to the present invention, 
there is provided a method of controlling a numerically 

25 controlled machine tool including the steps of taking nu- 
merical controlling program data from a reading and in- 
terpreting unit provided in a numerically controlling de- 
vice to execute the program data in a movement com- 
mand distribution controlling unit and a servo control 

30 unit; and outputting the execution to motor drive means 
of the feed shafts through feed shaft motor driving 
means to move a moving body by a feed mechanism, 
characterized in that the method comprises the steps of: 

35 calculating a torque or electric current command, 
based on a moving command value outputted from 
the movement command distribution controlling 
unit, in the servo control unit to output to the feed 
motor driving means to drive the feed motor; 

40 detecting an inversion of the direction of movement 
of the feed shaft; 

calculating the acceleration of the feed shaft at the 
time when he inversion of the direction of movement 
of the feed shaft is detected; 

45 calculating the load torque based on the torque 
electric current command outputted from the servo 
control unit at the time when the inversion of the di- 
rection of movement of the feed shaft is detected to 
set it as the load torque before the inversion of the 

so direction of movement of the feed shaft; 

inverting the sign of value of the toad torque and 
multiplying the load torque before the inversion of 
the direction of movement of the feed shaft by a pre- 
determined constant to set the product as a target 

55 value for the load torque for the operation after the 
inversion of the direction of movement of the feed 
shaft; 

calculating a load torque for the operation after the 
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direction of movement of the feed shaft is inverted, 
between the time of the detection of the inversion 
of the direction of movement of the feed shaft and 
the time when the load torque reaches the target 
value, by using a time constant expressed as a 5 
function of acceleration at the time of the inversion 
of the direction of the feed shaft; 
calculating a desired torque or electric current com- 
mand based on the load torque after the direction 
of movement of the feed shaft is inverted; 
outputting the desired torque or electric current 
command to motor drive means of the feed shafts; 
and 

moving the moving body by the feed shaft motor 
and the feed mechanism. 

[0025] The load torque after the inversion of the direc- 
tion of movement of the feed shaft may be calculated by 
using a time constant which is in inverse proportion to 
square root of the acceleration at the time when the in- 
version of the direction of movement of the feed shaft is 
detected. 

[0026] The calculation of the load torque after the in- 
version of the direction of movement of the feed shaft 
can be terminated by a ratio until the set point of load 
torque reaches or by a distance from the feed shaft 
when an inversion of the direction of movement of the 
feed shaft is detected. 

[0027] Further, according to the present invention, 
there is provided a method of controlling a numerically 
controlled machine tool including the steps of taking nu- 
merical controlling program data from a reading and in- 
terpreting unit provided in a numerically controlling de- 
vice to execute the program data in a movement com- 
mand distribution controlling unit and a servo control 
unit; and outputting the execution to motor drive means 
of the feed shafts through feed shaft motor driving 
means to move a moving body by a feed mechanism, 
characterized in that the method comprises the steps of: 

setting previously a desired torque command and a 
speed command or a desired electric current com- 
mand and a speed command, depending on the 
static frictional force in the feed mechanism; 
calculating a torque or electric current command, 
based on a moving command value outputted from 
the movement command distribution controlling 
unit, in the servo control unit to output to the feed 
motor driving means to drive the feed motor; 
detecting an inversion of the direction of movement 
of the feed shaft or an initiation of movement of the 
stationary feed shaft; 

outputting, when the inversion of the direction of 
movement of the feed shaft or the initiation of move- 
ment of the stationary feed shaft is detected, the de- 
sired torque command and the speed command or 
the desired electric current command and the 
speed command, which are previously set, to the 



feed shaft motor driving means and servo control 
means; and 

moving the moving body by the feed shaft motor 
and feed mechanism. 

[0028] Further, according to the present invention, 
there is provided a method of controlling a numerically 
controlled machine tool including the steps of taking nu- 
merical controlling program data from a reading and in- 
terpreting unit provided in a numerically controlling de- 
vice to execute the program data in a movement com- 
mand distribution controlling unit and a servo control 
unit; and outputting the execution to motor drive means 
of the feed shafts through feed shaft motor driving 
means to move a moving body by a feed mechanism, 
characterized in that the method comprises the steps of: 

setting previously a desired torque command and a 
speed command or a desired electric current com- 
mand and a speed command, depending on the 
static frictional force in the feed mechanism; 
calculating a torque or electric current command, 
based on a moving command value outputted from 
the movement command distribution controlling 
unit, in the servo control unit to output to the feed 
motor driving means to drive the feed motor; 
detecting an inversion of the direction of movement 
of the feed shaft or an initiation of movement of the 
stationary feed shaft; 

calculating the acceleration of the feed shaft at the 
time when he inversion of the direction of movement 
of the feed shaft is detected; 
calculating the load torque based on the torque 
electric current command outputted from the servo 
control unit at the time when the inversion of the di- 
rection of movement of the feed shaft is detected to 
set it as the load torque before the inversion of the 
direction of movement of the feed shaft; 
inverting the sign of value of the toad torque and 
multiplying the load torque before the inversion of 
the direction of movement of the feed shaft by a pre- 
determined constant to set the product as a target 
value for the load torque for the operation after the 
inversion of the direction of movement of the feed 
shaft; 

calculating a load torque for the operation after the 
direction of movement of the feed shaft is inverted, 
between the time of the detection of the inversion 
of the direction of movement of the feed shaft and 
the time when the load torque reaches the target 
value, by using a time constant expressed as a 
function of acceleration at the time of the inversion 
of the direction of the feed shaft; 
calculating a desired torque or electric current com- 
mand based on the load torque after the direction 
of movement of the feed shaft is inverted; 
outputting the desired torque or electric current 
command to motor drive means; 
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outputting, when the inversion of the direction of 
movement of the feed shaft or the initiation of move- 
ment of the stationary feed shaft is detected, the de- 
sired torque command and the speed command or 
the desired electric current command and the 5 
speed command, which are previously set, to the 
feed shaft motor driving means and servo control 
means; and 

moving the moving body by the feed shaft motor 
and feed mechanism. 

[0029] Further, according to the present invention, 
there is provided a method of controlling a numerically 
controlled machine tool including the steps of taking nu- 
merical controlling program data from a reading and in- 
terpreting unit provided in a numerically controlling de- 
vice to execute the program data in a movement com- 
mand distribution controlling unit and a servo control 
unit; and outputting the execution to motor drive means 
of the feed shafts through feed shaft motor driving 
means to move a moving body by a feed mechanism, 
characterized in that the method comprises the steps of: 

calculating a torque or electric current command, 
based on a moving command value outputted from 
the movement command distribution controlling 
unit, in the servo control unit to output to the feed 
motor driving means to drive the feed motor; 
taking the torque or electric current command out- 
putted to the feed shaft motor drive means through 
the servo control unit as a torque or electric current 
command for the moving feed shaft; 
calculating a load inertia based on the torque or 
electric current command for the moving feed shaft 
and the acceleration in the feed shaft; 
calculating a desired torque or electric current com- 
mand corresponding to the calculated load inertia; 
outputting the desired torque or electric current 
command to the feed motor shaft motor drive 
means; and 

moving the moving body by the feed shaft motor 
and the feed mechanism. 

[0030] Further, according to the present invention, 
there is provided a method of controlling a numerically 
controlled machine tool including the steps of taking nu- 
merical controlling program data from a reading and in- 
terpreting unit provided in a numerically controlling de- 
vice to execute the program data in a movement com- 
mand distribution controlling unit and a servo control 
unit; and outputting the execution to motor drive means 
of the feed shafts through feed shaft motor driving 
means to move a moving body by a feed mechanism, 
characterized in that the method comprises the steps of: 

calculating a torque or electric current command, 
based on a moving command value outputted from 
the movement command distribution controlling 
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unit, in the servo control unit to output to the feed 
motor driving means to drive the feed motor; 
detecting the weight of a workpiece or a moving 
body to which the workpiece is mounted; 
calculating a toad inertia based on the detected 
weight; 

calculating a desired torque or electric current com- 
mand based on the calculated load inertia; 
outputting the desired torque or electric current 
command to the speed shaft motor drive means; 
and 

moving the moving body by the feed shaft motor 
and the feed mechanism. 

[0031] Further, according to the present invention, 
there is provided a method of controlling a numerically 
controlled machine tool including the steps of taking nu- 
merical controlling program data from a reading and in- 
terpreting unit provided in a numerically controlling de- 
vice to execute the program data in a movement com- 
mand distribution controlling unit and a servo control 
unit; and outputting the execution to motor drive means 
of the feed shafts through feed shaft motor driving 
means to move a moving body by a feed mechanism, 
characterized in that the method comprises the steps of: 

calculating a torque or electric current command, 
based on a moving command value outputted from 
the movement command distribution controlling 
unit, in the servo control unit to output to the feed 
motor driving means to drive the feed motor; 
setting and storing a time constant of acceleration 
and deceleration of the feed shaft and allowable 
temperature data for feed shaft motor; 
taking the torque or electric current command out- 
putted from the servo control unit to the feed motor 
driving means; 

estimating the temperature of the feed shaft motor 
based on the taken torque or electric current com- 
mand; 

comparing the previously stored allowable temper- 
ature data and the estimated temperature of the 
feed shaft motor; 

calculating an acceleration deceleration time con- 
stant based on the comparison results; 
estimating a desired torque command or an electric 
current command corresponding to a change in the 
frictional force of the feed mechanism or the weight 
of a workpiece obtained based on the torque com- 
mand or the electric current command and the ac- 
celeration of the feed shaft outputted from the servo 
control unit to the feed shaft motor drive means; 
outputting the estimated desired torque or electric 
current command to the feed motor drive means; 
and 

moving the moving body by the feed shaft motor 
and the feed mechanism. 
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[0032] Further, according to the present invention, 
there is provided a numerically controlled machine tool 
having a plurality of feed shafts of three orthogonal X-, 
Y-, and Z-axes or at least one of rotary shafts of A-, B- 
and C-axes in addition to a plurality of feed shafts of 
three orthogonal X-, Y-, and Z-axes, characterized in 
that the numerically controlled machine tool comprises: 

a feed mechanism for moving a moving body of 
each feed shaft; 

a feed shaft motor for driving the feed mechanism; 
a feed shaft motor drive means for driving the feed 
shaft motor; 

a numerically controlling means for executing the 
numerically controlled program data to drive the 
feed shaft motor by a moving command distribution 
controlling unit and a servo control unit and for out- 
putting the result of execution to the feed shaft mo- 
tor through the feed shaft motor drive means; 
a calculation controlling means for estimating a de- 
sired torque command or an electric current com- 
mand corresponding to a change in the frictional 
force of the feed mechanism or the weight of a work- 
piece obtained based on the torque command or 
the electric current command and the acceleration 
of the feed shaft outputted from the servo control 
unit to the feed shaft motor drive means when the 
feed shaft motor is driven to output the estimated 
desired torque or electric current command to the 
feed motor drive means. 

[0033] Further, according to the present invention, 
there is provided a numerically controlled machine tool 
including a numerically controlling device which has a 
reading an interpreting unit, a movement command dis- 
tribution controlling unit for executing a numerical con- 
trol program data, which has been drawn from the read- 
ing an interpreting unit, the result of execution being out- 
putted to a feed shaft motor of a feed shaft through a 
feed shaft motor drive means to move a moving body 
by a feed mechanism, characterized in that the numer- 
ically controlled machine tool comprises: 

a feed mechanism for moving a moving body of 
each feed shaft; 

a feed shaft motor for driving the feed mechanism; 
a feed shaft motor drive means for driving the feed 
shaft motor; 

a numerically controlling means for executing the 
numerically controlled program data to drive the 
feed shaft motor by a moving command distribution 
controlling unit and a servo control unit and for out- 
putting the result of execution to the feed shaft mo- 
tor through the feed shaft motor drive means; 
a calculation controlling means for estimating a de- 
sired torque command or an electric current com- 
mand corresponding to a change in the frictional 
force of the feed mechanism orthe weight of a work- 
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piece obtained based on the torque command or 
the electric current command and the acceleration 
of the feed shaft outputted from the servo control 
unit to the feed shaft motor drive means when the 
5 feed shaft motor is driven to output the estimated 
desired torque or electric current command to the 
feed motor drive means. 

[0034] Further, according to the present invention, 
10 there is provided a numerically controlled machine tool 
including a numerically controlling device which has a 
reading an interpreting unit, a movement command dis- 
tribution controlling unit for executing a numerical con- 
trol program data, which has been drawn from the read- 
's ing an interpreting unit, the result of execution being out- 
putted to a feed shaft motor of a feed shaft through a 
feed shaft motor drive means to move a moving body 
by a feed mechanism, characterized in that the numer- 
ically controlled machine tool comprises: 

20 

a position control means for calculating a speed 
command based on a movement command of the 
feed shaft outputted from the movement command 
distribution controlling means; 

25 a speed control means for calculating a torque com- 
mand or an electric current command based on the 
speed command of the feed shaft outputted from 
the position control means; 
a feed shaft motor drive means for outputting an 

30 electric current to drive the feed shaft motor accord- 
ing to the torque command of the feed shaft or the 
electric current command outputted from the speed 
control means; 

a detecting means for detecting an inversion of the 
35 direction of movement of the feed shaft; 

an acceleration calculating means for calculating an 
acceleration when an inversion of the direction of 
movement of feed shaft by the detecting means; 
and 

40 a load torque calculating means for calculating a 
load torque after the inversion of the direction of 
movement of the feed shaft by using a time constant 
expressed by a function of the toque command or 
the electric current command outputted from the 

45 speed control means at the time when the inversion 
of the direction of movement of the feed shaft is de- 
tected by the detecting means and the acceleration, 
calculated by the acceleration calculating means, 
when the inversion of the direction of movement of 

50 the feed shaft is detected to output the calculated 
desired torque or electric current command corre- 
sponding to the load torque to the speed control 
means. 

55 [0035] Further, according to the present invention, 
there is provided a numerically controlled machine tool 
including a numerically controlling device which has a 
reading an interpreting unit, a movement command dis- 
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tribution controlling unit for executing a numerical con- 
trol program data, which has been drawn from the read- 
ing an interpreting unit, the result of execution being out- 
putted to a feed shaft motor of a feed shaft through a 
feed shaft motor drive means to move a moving body 
by a feed mechanism, characterized in that the numer- 
ically controlled machine tool comprises: 

a position control means for calculating a speed 
command based on a movement command of the 
feed shaft outputted from the movement command 
distribution controlling means; 
a speed control means for calculating a torque com- 
mand or an electric current command based on the 
speed command of the feed shaft outputted from 
the position control means; 
a feed shaft motor drive means for outputting an 
electric current to drive the feed shaft motor accord- 
ing to the torque command of the feed shaft or the 
electric current command outputted from the speed 
control means; 

a detecting means for detecting an inversion of the 
direction of movement of the feed shaft or the initi- 
ation of movement of the stationary feed shaft; and 
a static friction correcting means for outputting pre- 
determined desired torque command and speed 
command or electric current command and speed 
command, to the feed shaft motor drive means and 
the speed control means, corresponding to the stat- 
ic frictional force of the feed mechanism when the 
inversion of the direction of movement of the feed 
shaft or the initiation of the movement of the feed 
shaft is detected by the detecting means. 

[0036] Further, according to the present invention, 
there is provided a numerically controlled machine tool 
including a numerically controlling device which has a 
reading an interpreting unit, a movement command dis- 
tribution controlling unit for executing a numerical con- 
trol program data, which has been drawn from the read- 
ing an interpreting unit, the result of execution being out- 
putted to a feed shaft motor of a feed shaft through a 
feed shaft motor drive means to move a moving body 
by a feed mechanism, characterized in that the numer- 
ically controlled machine tool comprises: 

a position control means for calculating a speed 
command based on a movement command of the 
feed shaft outputted from the movement command 
distribution controlling means; 
a speed control means for calculating a torque com- 
mand or an electric current command based on the 
speed command of the feed shaft outputted from 
the position control means; 
a feed shaft motor drive means for outputting an 
electric current to drive the feed shaft motor accord- 
ing to the torque command of the feed shaft or the 
electric current command outputted from the speed 
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control means; 

a detecting means for detecting an inversion of the 
direction of movement of the feed shaft or the initi- 
ation of movement of the stationary feed shaft; and 
5 an acceleration calculating means for calculating 
the acceleration when the detecting means detects 
the inversion of the direction of movement of the 
feed shaft; 

a load torque calculating means for calculating a 
10 load torque after the inversion of the direction of 
movement of the feed shaft by using a time constant 
expressed by a function of the toque command or 
the electric current command outputted from the 
speed control means at the time when the inversion 
15 of the direction of movement of the feed shaft is de- 
tected by the detecting means and the acceleration, 
calculated by the acceleration calculating means, 
when the inversion of the direction of movement of 
the feed shaft is detected to output the calculated 
20 desired torque or electric current command corre- 
sponding to the load torque to the speed control 
means; 

a static friction correcting means for outputting pre- 
determined desired torque command and speed 

25 command or electric current command and speed 
command, to the feed shaft motor drive means and 
the speed control means, corresponding to the stat- 
ic frictional force of the feed mechanism when the 
inversion of the direction of movement of the feed 

30 shaft or the initiation of the movement of the feed 
shaft is detected by the detecting means. 

[0037] Further, according to the present invention, 
there is provided a numerically controlled machine tool 

35 including a numerically controlling device which has a 
reading an interpreting unit, a movement command dis- 
tribution controlling unit for executing a numerical con- 
trol program data, which has been drawn from the read- 
ing an interpreting unit, the result of execution being out- 

40 putted to a feed shaft motor of a feed shaft through a 
feed shaft motor drive means to move a moving body 
by a feed mechanism, characterized in that the numer- 
ically controlled machine tool comprises: 

45 a position control means for calculating a speed 

command based on a movement command of the 

feed shaft outputted from the movement command 

distribution controlling means; 

a speed control means for calculating a torque com- 
50 mand or an electric current command based on the 

speed command of the feed shaft outputted from 

the position control means; 

a feed shaft motor drive means for outputting an 

electric current to drive the feed shaft motor accord- 
55 ing to the torque command of the feed shaft or the 

electric current command outputted from the speed 

control means; 

a speed feedforward control means for estimating 
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a speed command based on the movement com- 
mand of the feed shaft outputted from the move- 
ment command distribution controlling unit by cal- 
culation to output the speed command to the speed 
control means; 

an acceleration feedforward control means for esti- 
mating an acceleration or torque command of the 
feed shaft outputted from the movement command 
distribution controlling unit by calculation to output 
the acceleration or torque command to the feed 
shaft motor drive means; and 
an inertia calculating means for calculating a load 
inertia based on the torque or electric current com- 
mand, outputted to the feed shaft motor drive 
means from the speed control means, and the ac- 
celeration of the feed shaft to output the load inertia 
to the speed control means and the acceleration 
feed forward control means, the speed control 
means outputs a desired torque or electric current 
command based n the load inertia, calculated by the 
inertia calculating means, to the speed shaft motor 
drive means. 

[0038] Further, according to the present invention, 
there is provided a numerically controlled machine tool 
including a numerically controlling device which has a 
reading an interpreting unit, a movement command dis- 
tribution controlling unit for executing a numerical con- 
trol program data, which has been drawn from the read- 
ing an interpreting unit, the result of execution being out- 
putted to a feed shaft motor of a feed shaft through a 
feed shaft motor drive means to move a moving body 
by a feed mechanism, characterized in that the numer- 
ically controlled machine tool comprises: 

a position control means for calculating a speed 
command based on a movement command of the 
feed shaft outputted from the movement command 
distribution controlling means; 
a speed control means for calculating a torque com- 
mand or an electric current command based on the 
speed command of the feed shaft outputted from 
the position control means; 
a feed shaft motor drive means for outputting an 
electric current to drive the feed shaft motor accord- 
ing to the torque command of the feed shaft or the 
electric current command outputted from the speed 
control means; 

a speed feedforward control means for estimating 
a speed command based on the movement com- 
mand of the feed shaft outputted from the move- 
ment command distribution controlling unit by cal- 
culation to output the speed command to the speed 
control means; 

an acceleration feedforward control means for esti- 
mating an acceleration or torque command of the 
feed shaft outputted from the movement command 
distribution controlling unit by calculation to output 



the acceleration or torque command to the feed 
shaft motor drive means; 

a weight detecting means for detecting the weight 
of a workpiece or a moving body to which the work- 

5 piece is mounted; and 

an inertia calculating means for calculating a load 
inertia based on the torque or electric current com- 
mand, outputted to the feed shaft motor drive 
means from the speed control means, and the ac- 

10 celeration of the feed shaft to output the load inertia 
to the speed control means and the acceleration 
feed forward control means, the speed control 
means outputting a desired torque or electric cur- 
rent command based on the load inertia, calculated 

15 by the inertia calculating means, to the speed shaft 
motor drive means. 

[0039] Further, according to the present invention, 
there is provided a feed mechanism for moving a moving 
20 body of each feed shaft; 

a feed shaft motor for driving the feed mechanism; 
a feed shaft motor drive means for driving the feed 
shaft motor; 

25 a numerically controlling means for executing the 
numerically controlled program data to drive the 
feed shaft motor by a moving command distribution 
controlling unit and a servo control unit and for out- 
putting the result of execution to the feed shaft mo- 
30 tor through the feed shaft motor drive means; 

a data storage means for storing a time constant of 
acceleration and deceleration of the feed shaft and 
allowable temperature data for feed shaft motor; 
a temperature calculating means for estimating, 
35 through an calculation, the temperature of the feed 
shaft motor based on the torque or electric current 
command outputted to the feed shaft motor drive 
means from the servo motor control means; 
an acceleration deceleration time constant calculat- 
40 ing means for setting an acceleration deceleration 
time constant based on a comparison between the 
allowable temperature data previously stored in the 
data storing means and the temperature of the feed 
shaft motor estimated by the temperature calculat- 
es jng means to output the resultant time constant to 
the movement command distribution controlling 
unit; and 

a calculation controlling means for estimating a de- 
sired torque command or an electric current com- 

50 mand corresponding to a change in the frictional 
force of the feed mechanism or the weight of a work- 
piece obtained based on the torque command or 
the electric current command and the acceleration 
of the feed shaft outputted from the servo control 

55 unit to the feed shaft motor drive means when the 
feed shaft motor is driven to output the estimated 
desired torque or electric current command to the 
feed motor drive means. 
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[0040] In the numerically controlled machine tool of 
the present invention, according to the movement com- 
mand outputted from the movement command distrib- 
uting control unit, it is possible to conduct the detection 
of start of movement from stoppage, calculation of ac- 
celeration by the second order differentiation, feedfor- 
ward control of speed, and feedforward control of accel- 
eration. Therefore, before the feed shaft motor is driven, 
control can be conducted by the calculation controlling 
means. Accordingly, even if the feed speed is high, ma- 
chining can be conducted with high accuracy. 
[0041] According to the present invention, the temper- 
ature of the feed shaft motor is estimated by calculation 
and compared with the predetermined temperature data 
allowed to the feed shaft motor, and the time constant 
of acceleration and deceleration of the feed shaft is 
changed according to the result of comparison. Further, 
the desired torque command or electric current com- 
mand corresponding to changes in the frictional force of 
the feed shaft and the weight of a workpiece is outputted 
into the feed shaft motor drive means. In the present 
invention, the above control can be conducted being 
combined. 

[0042] As described above, according to the present 
invention, it is possible to provide a method of controlling 
a numerically controlled machine tool by which machin- 
ing can be conducted with high accuracy even when a 
moving body of the machine tool is moved at high speed, 
also it is possible to provide a numerically controlled ma- 
chine tool by which machining can be conducted with 
high accuracy even when a moving body of the machine 
tool is moved at high speed. Even if the quadrant of a 
feed shaft is changed over while profile machining or 
curved face machining is being conducted by moving a 
plurality of feed shafts simultaneously, or even if the 
weight of a workpiece given to the feed shaft is changed, 
machining accuracy can be kept high. 
[0043] Even if a change is caused in the dynamic and 
static frictional force of the feed mechanism at the inver- 
sion of movement of the feed shaft and at the start of 
movement from stoppage, it is possible to conduct ma- 
chining with high accuracy. When a workpiece mounted 
on the moving body of the feed shaft is replaced or an 
attachment used for attaching the workpiece is replaced 
and also when the weight of a workpiece is reduced with 
time while it is being machined, a desired torque com- 
mand or electric command is outputted into the feed 
shaft motor drive means while it follows a change in in- 
ertia caused by the change in the weight. Therefore, the 
machining accuracy can be kept high. Further, even 
when the feed shaft motor is continuously operated be- 
ing frequently accelerated and decelerated, there is no 
possibility of overheat of the feed shaft motor. Accord- 
ingly, machining can be conducted with high accuracy. 
[0044] The present invention is compared with the 
aforementioned five prior arts as follows. According to 
the first prior art, various accelerations caused by lost 
motions are added to the speed command of the servo 



control unit, and the feed shaft motor is driven via the 
speed control unit after that. On the other hand, accord- 
ing to the present invention, the desired torque com- 
mand or electric current command is estimated by cal- 

5 culation, and the result of estimation is directly outputted 
into the feed motor shaft drive means. Therefore, the 
feed shaft motor can be driven without causing any de- 
lay. According to the second prior art, there still exists a 
delay in servo system of the positional feedback con- 
to trolling means and the speed feedback controlling 
means. However, according to the present invention, 
the above delay is not caused. According to the third 
prior art, acceleration of the feed shaft is controlled so 
that it can be lowered. On the other hand, according to 

15 the present invention, acceleration of the feed shaft is 
kept at an appropriate predetermined value, and a de- 
sired torque command or electric current command is 
outputted into the feed shaft motor drive means when a 
value of inertia is changed. Therefore, the machining ef- 

20 ficiency is not be deteriorated. According to the fourth 
prior art, the torque observer detects a change in the 
load torque estimated by the speed command, and the 
load inertia is estimated. On the other hand, according 
to the present invention, load inertia is calculated by us- 

25 jng the torque command or electric current command 
actually outputted into the feed shaft motor drive means. 
Therefore, more actual load inertia can be found, and 
an accurate torque command can be outputted into the 
feed shaft motor drive means. The fifth prior art relates 

30 to a technique for preventing the feed shaft motor from 
overheating. On the other hand, according to the 
present invention, a desired torque command or electric 
current command corresponding to changes in the fric- 
tional force of the feed mechanism and the weight of a 

35 workpiece is outputted into the feed shaft motor drive 
means. Therefore, machining can be conducted with 
high accuracy. 
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BRIEF DESCRIPTION OF THE DRAWINGS 



[0045] Fig. 1 is an overall arrangement view of the nu- 
merically controlled machine tool of the present inven- 
tion. 

[0046] Fig. 2 is a block diagram showing a structure 
45 of the first embodiment of the control unit for controlling 
the numerically controlled machine tool of the present 
invention. 

[0047] Fig. 3 is a block diagram showing a structure 
of the second embodiment of the control unit for control- 
50 ling the numerically controlled machine tool of the 
present invention. 

[0048] Fig. 4 is a block diagram showing a structure 
of the third embodiment of the control unit for controlling 
the numerically controlled machine tool of the present 
55 invention. 

[0049] Fig. 5 is a block diagram showing a structure 
of the fourth embodiment of the control unit for control- 
ling the numerically controlled machine tool of the 
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present invention. 
[0050] Fig. 6 is a block diagram showing a structure 
of the fifth embodiment of the control unit for controlling 
the numerically controlled machine tool of the present 
invention. 

[0051] Fig. 7 is a view for explaining an inversion of 
the direction of the feed shaft, wherein an upper portion 
of Fig. 7 is a graph showing a change in the feed speed 
with respect to the time, and a lower portion of Fig. 7 is 
a graph showing a change in the load torque with re- 
spect to the time. 

[0052] Fig. 8 is a view for explaining a method of cal- 
culating the load inertia, wherein an upper portion of Fig. 
8 is a graph showing a change in the feed speed with 
respect to the time, a middle portion of Fig. 8 is a graph 
showing a change in the acceleration with respect to the 
time, and a lower portion of Fig. 8 is a graph showing a 
change in the load torque with respect to the time. 
[0053] Fig. 9A is a flow chart showing a method of cal- 
culating the load inertia. 

[0054] Fig. 9B is a flow chart showing a method of cal- 
culating the load inertia. 

[0055] Fig. 10 is a flow chart showing a controlling 
method of the fifth embodiment of the present invention. 
[0056] Fig. 1 1 is a graph showing a temperature curve 
of the feed shaft motor which is made in the fifth embod- 
iment of the present invention. 
[0057] Fig. 12 is a graph showing a relation between 
inclination 9 of the temperature curve and acceleration 
and deceleration time constant x in the fifth embodiment 
of the present invention. 

THE MOST PREFERRED EMBODIMENT 

[0058] Referring to Fig. 1, the numerically controlled 
machine tool of the present invention will be explained 
below. 

[0059] As shown in Fig. 1 , the numerically controlled 
machine tool 10 is a horizontal type machining center 
and provided with the bed 12 which is set on the floor of 
a factory. On the upper face of the bed 12, there is pro- 
vided a Z-axis guide rail 28 in the horizontal direction of 
Z-axis. In Fig. 1, the horizontal direction of Z-axis is a 
traverse direction. The table 14, to which a workpiece 
W is fixed, is slidably attached to the Z-axis guide rail 
28. Fig. 1 shows an example in which NC rotary table 
capable of rotating round B-axis is fixed onto the table 
14 and the workpiece W is mounted on the NC rotary 
table. However, it is possible to directly mount the work- 
piece W on the table 14 without arranging the NC rotary 
table. On the upper face of the bed 12, X-axis guide rail 
36 is arranged in a horizontal direction perpendicular to 
Z-axis, that is, X-axis guide rail 36 is arranged in a di- 
rection perpendicular to the surface of Fig. 1 . The col- 
umn 16 is slidably attached to the X-axis guide rail 36. 
In the column 16, Y-axis guide rail 34 is arranged in the 
direction of Y-axis which is perpendicular to both X-axis 
and Z-axis, that is, Y-axis guide rail 34 is arranged in the 
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direction of the upper and lower sides of Fig. 1 . The spin- 
dle head 18 for pivotally supporting the main spindle 20 
is slidably attached to the Y-axis guide rail 34. 
[0060] On the lower side of the table 14 in the bed 12, 

5 Z-axis feed screw 24 is arranged in the direction of Z- 
axis which is used as a Z-axis feed shaft. The nut 26 
screwed to the Z-axis feed screw 24 is fixed to the lower 
face of the table 14. Z-axis feed servo motor M z is con- 
nected with one end of the Z-axis feed screw 24. When 

10 servo motor M z is driven so as to rotate the Z-axis feed 
screw 24, the table 14 is moved along the Z-axis guide 
rail 28. In the same manner, on the lower side of the 
column 1 6 in the bed 1 2, X-axis feed screw (not shown), 
which is an X-axis feed shaft, is arranged in the direction 

15 of X-axis. On the lower face of the column 16, a nut (not 
shown) screwed to the X-axis feed screw is fixed. X-axis 
feed servo motor M x is connected with one end of the 
X-axis feed screw. When X-axis feed servo motor M x is 
driven and the X-axis feed screw is rotated, the column 

20 16 is moved along the X-axis guide rail 36. Further, Y- 
axis feed screw 32, which is a Y-axis feed shaft, is ar- 
ranged in the column 16 in the direction of Y-axis. On 
the back of the spindle head 18, the nut 30 screwed to 
the Y-axis feed screw 32 is fixed. Y-axis feed servo mo- 

25 tor M Y is connected with an upper end of the Y-axis feed 
screw 32. When the Y-axis feed servo motor M Y is driven 
and the Y-axis feed screw 32 is rotated, the spindle head 
18 is moved along the Y-axis guide rail 34. 
[0061] A tool 22, for example, an end mill is attached 

30 to the forward end of the main spindle 20. While the tool 
22 is being rotated, the column 16, spindle head 18 and 
table 14 are relatively moved in the directions of X, Y 
and Z axis. Due to the foregoing, the workpiece W fixed 
to the table 14 can be machined into a predetermined 

35 shape. When NC rotary table is fixed to the machine, 
the numerically controlled machine tool 10 can be said 
to be a four-axis type numerically controlled machine 
tool having B-axis. 

[0062] The numerically controlled machine tool 10 in- 

40 dudes a numerically control unit 40 for controlling servo 
motors M x , M Y and M z for feeding in the three axis di- 
rections of X, Y and Z axis of the column 16, spindle 
head 18 and table 14. Of course, in the case where NC 
rotary table is fixed to the machine, B-axis feed servo 

45 motor M B (not shown) is provided. The numerically con- 
trol unit 40 includes: a program reading and interpreting 
unit 44 for reading and interpreting NC program 42; an 
interpreted program storing unit 46 for temporarily stor- 
ing an interpreted program; a program execution com- 

50 manding unit 48 for appropriately drawing a program 
from the interpreted program storing unit 46 and output- 
ting execution program data; a movement command 
distributing control unit 50 for outputting a movement 
command of each direction of X, Y and Z axis according 

55 to the execution program data from the program execu- 
tion commanding unit 48; and a servo control unit 52 for 
outputting a torque command or electric current com- 
mand to the feed shaft motor driving unit 54 according 
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to the movement command from the movement com- 
mand distributing control unit 50 and also according to 
the feedback signal described later. The feed shaft mo- 
tor driving unit 54 outputs an electric current according 
to the torque command or electric current command 
sent from the servo control unit 52 so as to drive feed 
shaft motors M x , M Y and M z of X, Y and Z axis. Further, 
in this embodiment, there is provided a calculation con- 
trol unit 56 for correcting a torque command or electric 
current command sent from the servo control unit 52 to 
the feed shaft motor driving unit 54. 
[0063] Next, referring to Fig. 2, a preferred embodi- 
ment including the servo control unit 52 and the calcu- 
lation control unit 56 will be explained below. In the em- 
bodiment shown in Fig. 2, the calculation control unit 56 
is provided with the load torque calculating unit 70 by 
which backlash acceleration correction is conducted. 
Like reference characters are used to indicate like parts 
in Figs. 1 and 2. In the following descriptions, only the 
feed control of 2-axis on the table 14 is explained, how- 
ever, it should be understood that likewise the feed con- 
trol of X-axis and Y-axis can be executed. 
[0064] The servo control unit 52 includes: a subtracter 
58 for comparing the movement command sent from the 
movement command distribution control unit 50 with the 
position feedback signal sent from position detector SP 
such as a digital liner scale attached to the table 14; a 
position control unit 60 for amplifying an output from the 
subtracter 58; a subtracter 62 for comparing the output 
value of the position control unit 60 with the speed feed- 
back signal from pulse coder PC attached to feed shaft 
motor M z ; and a speed control unit 64 for amplifying an 
output of the subtracter 62. 

[0065] On the other hand, the movement command 
outputted from the movement command distribution 
control unit 50 is sent to both the detecting unit 66 and 
the acceleration calculating unit 68 every second. The 
detecting unit 66 analyzes a movement command sent 
from the movement command distributing control unit 
50 and monitors a change in the direction of movement 
of the table 14. When the direction of movement of the 
table 14 is inverted, the direction of movement inverting 
signal is output to the acceleration calculating unit 68 
and to the load torque calculating unit 70 which provides 
an example of the calculating control unit 56. 
[0066] The load torque calculating unit 70 includes a 
time constant calculating unit 72, load torque correction 
calculating unit 74, and load torque detecting unit 76 as 
essential components. The acceleration calculating unit 
68 conducts the second order differentiation on the mov- 
ing command so as to find an acceleration of the moving 
body, and the thus found acceleration is sent to the time 
constant calculating unit 72. The time constant calculat- 
ing unit 72 calculates a time constant according to the 
acceleration sent from the acceleration calculating unit 
68. On the other hand, the load torque detecting unit 76 
receives a direction of movement inverting signal sent 
from the detecting unit 66 and a torque command or 
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electric current command which is an output of the 
speed control unit 64 of the servo control unit 52 to out- 
put a torque command or electric current command im- 
mediately before the inversion of the direction of move- 

5 ment of the table 14 to the load torque correction calcu- 
lating unit 74. In this case, it is possible to receive an 
actual electric current outputted to feed shaft motor M z 
from the feed shaft motor driving unit 54 according to 
the torque command or electric current command out- 

10 putted from the speed control unit 64 to provide a torque 
command or electric current command immediately be- 
fore the inversion in the direction of movement of the 
table 14 to the load torque correction calculating unit 74. 
The load torque correction calculating unit 74 calculates 

1 5 a load torque correction value according to the time con- 
stant, which is a result of the calculation conducted by 
the time constant calculating unit 72, and also according 
to the torque command or electric current command im- 
mediately before the inversion in the direction of move- 

20 ment which is sent from the load torque detecting unit 
76. Then, the thus calculated load torque correction val- 
ue is sent to the speed control unit 64. The inversion in 
the direction of movement and the calculation of the ac- 
celeration may not be found from the movement com- 

25 mand, but they may be found by taking in the output sig- 
nal outputted from the position control unit 60. Also, they 
may be found by using the acceleration sensor attached 
to the moving body. 

[0067] Referring to Fig. 7, there is shown a state in 

30 which feed control is conducted under the condition that 
the acceleration is constant. The graph drawn in the up- 
per portion Fig. 7 shows a change in the feed speed with 
respect to the time, and the graph drawn in the lower 
portion Fig. 7 shows a change in the load torque corre- 

35 spondingly impressed upon the feed shaft with respect 
to the time. In Fig. 7, the change in speed with respect 
to the time is expressed in such a manner that changes 
in speed difference AV with respect to predetermined 
time difference AT are connected with each other by 

40 straight lines. 

[0068] In the graph shown in Fig. 7, the moment at 
which feed speed V is changed from negative to positive 
(At this moment, the feed speed is zero.) is indicated by 
mark Tc. At this time, the load torque changes as follows. 

45 The load torque changes from load torque Qp, which is 
a torque before Tc, to target load torque Qt. In the ex- 
ample shown in Fig. 7, under the condition that the ac- 
celeration is constant, the absolute value of previous 
load torque Qp, which is a torque before TC, is the same 

so as the absolute value of target load torque Qt, and the 
sign (+, -) of previous load torque Qp is opposite to the 
sign (+, -) of target load torque Qt. 
[0069] The above inversion of the direction of drive of 
the servo motor is caused, for example, at a turning point 

55 of the movement path of the tool 22 from one quadrant 
to the other when the numerically controlled machine 
tool 10 conducts cutting process along an arc. At this 
point, due to the backlash and friction of the feed screw, 
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the machine tool can not instantly invert so that a delay 
is caused generally in the motion of the machine tool. 
Therefore, the load torque is gradually changed from 
previous load torque Qp to target load torque Qt, as 
shown by a broken line in the graph. As a result, a pro- 5 
trusion is produced in the machined face of a workpiece. 
[0070] The inventors made various experiments and 
found the following conditions which allows no protru- 
sion or recess to be produced in the machined face of 
a workpiece when the direction of movement of the mov- 
ing body is inverted. There is a certain correlation be- 
tween the load torque correction and the acceleration of 
the moving body. In particular, if the time constant of the 
load torque correction is a value which is in inverse pro- 
portion to square root of the acceleration, the occur- 
rence of the above defects in the machined face can be 
prevented. 

[0071] According to the above knowledge, the load 
torque correction is found as follows, in this embodi- 
ment. First, a change in the direction of movement of 
the table 14 is monitored by the detecting unit 66. When 
the direction of movement of the table 14 is inverted, a 
direction of movement inversion signal is outputted from 
the detecting unit 66 to the acceleration calculating unit 
68 and the load torque calculating unit 70. The acceler- 
ation calculating unit 68 sends an acceleration of the 
moving body to the time constant calculating unit 72 
when the acceleration calculating unit 68 receives the 
direction of movement inversion signal. The time con- 
stant calculating unit 72 calculates the time constant by 
the following formula based on the acceleration from the 
acceleration calculating unit 68, and the thus the ob- 
tained time constant is sent to the load torque correction 
calculating unit 74. 

i 

x = koc 2 

[0072] In the above formula, x is time constant, a is 
acceleration, and k is a coefficient for the time constant. 
[0073] At this time, the load torque detecting unit 76 
sends the output value of the speed control unit 64, at 
the direction of movement inversion signal being re- 
ceived, as a load torque before the inversion of the di- 
rection of movement, to the load torque correction cal- 
culating unit 74. The load torque correction calculating 
unit 74 sets the load torque Qp before the inversion in 
the direction of movement from the load torque detect- 
ing unit 76 as a load torque reference value Qs. Next, 
the load torque correction calculating unit 74 inverts the 
sign of the load torque Qp before the inversion in the 
direction of movement (that is, + - are changed from 
each other), and thus obtained value is multiplied by a 
predetermined constant to provide a load torque target 
value Qt on the feed shaft after the inversion in the di- 
rection of movement. Next, according to the following 
formula, the load torque correction calculating unit 74 
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finds load torque correction AQ to be added to the load 
torque generated by the speed control unit 64 based on 
the movement command and the feedback signal. 

AQ = a x Qs x - 
x 

1 

1 2 

= a x Qs x - a 

[0074] Where, the constant "a" is a constant which 
may be found by experiments. For example, "a" is relat- 
ed to the acceleration of the moving body obtained by 
the acceleration calculating unit 68, and stored and ac- 
commodated as a data table so that it can be appropri- 
ately called out and used based on acceleration a. 
[0075] As described above, correction AQ is calculat- 
ed by time constant x which is expressed by a function 
of acceleration a in the case of an inversion in the direc- 
tion of movement. Based on the correction AQ, an in- 
crement for the load torque Q, at an inversion in the di- 
rection of movement, up to the target load torque Qt 
which has been set when the inversion in the direction 
of movement of the table 14 is detected. Based on the 
load torque Q, the speed control unit 64 calculates a de- 
sired torque command or electric current command cor- 
responding to the load torque Q after the inversion in 
the direction of movement. The torque command or 
electric current command thus obtained is outputted to 
the feed shaft motor driving unit 54, and feed shaft motor 
M z is driven to move the table 14. 
[0076] In the embodiment shown in Fig. 2, the time 
constant is found as a value which is in inverse propor- 
tion to the square root of the acceleration. The above 
method gives an excellent result when the table 14, col- 
umn 16 and spindle head 18, which provide the moving 
body, are relatively light. However, when the table 14, 
column 1 6 and spindle head 1 8, which provide the mov- 
ing body, are relatively heavy, or when the static friction 
is high, time constant obtained by 1/3 or 3/5 power of 
the acceleration instead of the square may provide re- 
sults better. The calculation of correction AQ for the load 
torque may be terminated based on the increment for 
the load torque up to the target Qt or on the distance 
from the position of the feed shaft at the inversion in the 
direction of movement. 

[0077] In case that coefficient of static friction is high, 
two time constants x1 and x2, one is larger than the oth- 
er, may be used so that when the direction of movement 
is inverted, the smaller time constant x1 is selected, and 
then the larger time constant x2 is selected. This allows 
high load torque to be impressed on the shaft feed servo 
motors M x , M Y and M z immediately after the inversion 
in the direction of movement, so that the delay of the 
servo control is reduced, as shown by the solid line on 
the graph on the lower side of Fig. 7. 
[0078] In case that the coefficient of static friction is 
high, a static friction correcting unit 80 may be added to 
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the embodiment of Fig. 2 as shown in Fig. 3. That is, a 
desired torque command, electric current command or 
speed command corresponding to the static friction of 
the feed mechanism is previously set, and a torque com- 
mand or electric current command sent to the feed shaft 
motor driving unit 54 can be determined based on the 
preset desired torque command, electric current com- 
mand or speed command. Incidentally, like reference 
numbers are used to indicate like parts in Figs. 1, 2 and 
3. 

[0079] In the embodiment shown in Fig. 3, the static 
friction correcting unit 80 is provided between the de- 
tecting unit 66 and the servo control unit 52. The static 
friction correcting unit 80 outputs the speed correction 
82, which is a desired speed command, and the torque 
correction 84, which is a desired torque command, re- 
spectively to the subtracter 62 and the subtracter 94 ar- 
ranged in the downstream of the speed control unit 64. 
Static friction causes a problem when including the table 
14, column 16 and spindle shaft 18, which provide the 
moving body, start moving from stationary state, and al- 
so the static friction causes a problem when the direction 
of movement of the moving body is inverted. Therefore, 
in the embodiment shown in Fig. 3, according to the 
movement command sent from the movement com- 
mand distribution control unit 50, the detecting unit 66 
sends out not only the direction of movement inversion 
signal of the moving body but also the movement initia- 
tion signal, which indicates that the moving body has 
started moving from stationary state, to the load torque 
calculating unit 70 and static friction correcting unit 80. 
The load torque calculating unit 70 acts substantially the 
same as the embodiment shown in Fig. 2. 
[0080] When the static friction correcting unit 80 re- 
ceives a direction of movement inversion signal or 
movement initiation signal from the detecting unit 66, a 
predetermined speed command is sent to the subtracter 
62, that is, a speed command in the shape of inverted 
"V" or triangule, in which the speed increases linearly 
and then decreases linearly with respect to the time, is 
sent to the subtracter 62. At the same time, the static 
friction correcting unit 80 outputs a predetermined 
torque command composed of rectangular waves to the 
subtracter 94 arranged in the downstream of the speed 
control unit 64 to control the acceleration of feed shaft 
motor M z . 

[0081] According to the prior art, with the load inertia 
assumed to be constant, and a value, which is obtained 
by multiplying the load inertia by the acceleration at eve- 
ry moment, is outputted to the feed shaft motor driving 
unit 54 as a torque command. However, the load inertia 
changes with the weight of a workpiece fixed to the table 
14 and also changes with the progression of machining 
of the workpiece. Therefore, if the torque command is 
kept constant, it is impossible to improve the machining 
accuracy. 

[0082] Therefore, in the embodiment shown in Fig. 4, 
the change in the load inertia is calculated to determine 



26 

the torque command or electric current command given 
to the feed shaft motor driving unit 54, based on the cal- 
culated load inertia. Incidentally, like reference numbers 
are used to indicate like parts in Figs. 2, 3 and 4. 

5 [0083] The embodiment shown in Fig. 4 includes an 
inertia calculating unit 96 and an inertia storing unit 98 
which provides to the calculation control unit 56 shown 
in Fig. 1. In the embodiment shown in Fig. 4, the servo 
control unit 52 includes not only a position control unit 

10 60 and speed control unit 64 but also speed feedforward 
control unit 90 and acceleration feedforward control unit 
92. The speed feedforward control unit 90 and acceler- 
ation feedforward control unit 92 generate a speed feed- 
forward value and acceleration feedforward value 

15 based on the position command sent from the move- 
ment command distribution control unit 50. 
[0084] The speed feedforward control unit 90 con- 
ducts the first order differentiation on the movement 
command sent from the movement command distribu- 

20 tion control unit 50 to calculate a speed. The speed thus 
calculated is outputted to the inertia calculating unit 96 
and the subtracter 62 arranged in the downstream of the 
position control unit 60 as a speed feedforward value. 
The acceleration feedforward control unit 92 operates 

25 as follows. The acceleration feedforward control unit 92 
calculates an acceleration by conducting the second or- 
der differentiation on the movement command sent from 
the movement command distribution control unit 50. 
The thus calculated acceleration is outputted to the in- 

30 ertia control unit 96, and at the same time, the calculated 
acceleration is multiplied by the value of inertia so as to 
calculate the acceleration feedforward value. The accel- 
eration feedforward value thus calculated is outputted 
to the subtracter 94 arranged in the downstream of the 

35 speed control unit 64. 

[0085] In the subtracter 62, a difference between the 
speed feedforward value, the output from the position 
control unit 60 and the speed feedback signal sent from 
the pulse coder PC is inputted into the speed control unit 

40 64. In the speed control unit 64, the difference is suc- 
cessively multiplied by the gain 64a and inertia 64b, so 
that the load torque is outputted. The acceleration feed- 
forward value from the acceleration feedforward control 
unit 92 is added to the load torque to obtain the torque 

45 command, and the torque command thus obtained is 
outputted to the feed shaft motor driving unit 54. 
[0086] The inertia calculating unit 96 calculates the 
load inertia as follows based on the speed from the 
speed feedforward control unit 90, the acceleration from 

so the acceleration feedforward control unit 92 and the 
torque command or electric current command inputted 
to the feed shaft motor driving unit 54. 
[0087] Referring to Fig. 8, changes in speed, acceler- 
ation and torque are shown as functions with respect to 

55 the time in case that the moving body is accelerated 
from stationary state to predetermined speed V1 by a 
constant acceleration and the moving body is rapidly tra- 
versed at speed V1 . Referring to the flow charts shown 
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in Figs. 9A and 9B, the operation of the present embod- 
iment will be explained below on the assumption that 
the speed, acceleration and torque are changed as 
shown in Fig. 8. 

[0088] First, after a rapid traverse signal is received, 
step S10 determines, by the speed sent from the speed 
feedforward control unit 90 and the acceleration sent 
from the acceleration feedforward control unit 92, 
whether the shaft feed is rapid traverse condition or not. 
If the shaft feed is not rapid traverse condition, that Is, 
when the result is "No" in step S10, the flow chart waits 
for rapid traverse condition. If the shaft feed is rapid 
traverse condition, that is, when the result is "Yes" in 
step S10, step S12 determines, by the change in the 
acceleration sent from the acceleration feedforward 
control unit 92, whether the shaft feed is accelerated un- 
der the condition of a constant acceleration or not. If the 
shaft is fed at a constant acceleration, that is, when the 
result is "Yes" in step S12, in step S14, the torque of the 
shaft, which is being accelerated, is subjected to sam- 
pling through the torque command or electric current 
command sent to the feed shaft motor drive unit 54. 
When the sampling is conducted by the predetermined 
number N, the above sampling is completed, that is, 
when the result is "Yes" in step S1 6, the above sampling 
is completed. When the number of times of sampling is 
smaller than N, that is, when the result is "No" in step 
S1 6, the program returns to step S10, and the sampling 
of torque is conducted again. 

[0089] In the case where the shaft is not fed at a con- 
stant acceleration, that is, when the result is "No" in step 
S12, step S1 8 determines, by the change in the speed 
sent from the speed feedforward control unit 90, wheth- 
er the shaft is fed at a constant speed or not. When the 
shaft is fed at a constant speed, that is, when the result 
is "Yes" in step S18, in step S20, sampling is conducted 
to the torque, while the shaft is fed at a constant speed, 
through the torque command or electric current com- 
mand sent to the feed shaft motor driving unit 54. When 
this sampling is conducted by the predetermined 
number M, the above sampling is completed, that is, 
when the result is "Yes" in step S22, the above sampling 
is completed. When the number of sampling is smaller 
than M, that is, the result is "No" in step S22, the program 
returns to step S10, and the sampling of torque is con- 
ducted again. 

[0090] When the torque sampling is completed under 
the condition that the acceleration is constant or the 
speed is constant, average Q1 of torque under the ac- 
celeration condition and average Qr of torque under the 
constant speed condition are calculated in step S24. 
Next, in steps S26 and S28, friction torque Qf, which is 
proportional to the speed under the acceleration condi- 
tion, and acceleration torque Qa are calculated by the 
torque under the constant speed condition with the fol- 
lowing equation. 



Qf = Qr x (Vm/Vr) 



5 Qa = Qm - Qf = Qm - Qr x (Vm/Vr) 

where 

Vr: constant shaft feed speed under a rapid traverse 
10 Vm: average shaft feed speed under a constant ac- 
celeration a 

a: constant acceleration under the acceleration 
condition 

Qm: average torque under an acceleration a 
15 Qr: average torque at a constant speed under a rap- 
id traverse condition 
Qa: acceleration torque 

[0091] Next, in step S30, load inertia J is calculated 
20 with the following equation. 

J = Qa/cc-JM 

25 [0092] Where, J is load inertia, and JM is motor inertia. 
[0093] Next, in step S32, the inertia calculating unit 
96 calculates an acceleration feedforward value relative 
to this load inertia J, and revise the acceleration feed- 
forward value which has been sent to and stored in the 

30 inertia storing unit 98 (step S34). 

[0094] The inertia value thus calculated is outputted 
to the speed control unit 64 so that the latest inertia value 
is used when the torque command or the electric current 
command is calculated. At the same time, the calculated 

35 inertia value is outputted also to the acceleration feed- 
forward control unit 92 so that the latest inertia value is 
used when the acceleration feedforward value to be out- 
putted to the adder 94 is calculated. The load inertia J 
may be calculated based on in the torque command or 

40 the electric current command given to the feed shaft mo- 
tor driving unit 54. 

[0095] In the embodiment shown in Fig. 4, in order to 
calculate load inertia J, the speed and acceleration out- 
putted by the speed feedforward control unit 90 and the 

45 acceleration feedforward control unit 92 are used. How- 
ever, it should be noted that the present invention is not 
limited to the above specific embodiment. For example, 
as shown in Fig. 5, load inertia J may be calculated in 
such a manner that a change in the weight of the work- 

50 piece W is directly measured with the weight detector 
1 00 such as a strain gauge attached to the table 1 4, and 
the measured value is outputted into the inertia calcu- 
lating unit 98 to calculate the load inertia J. 
[0096] Next, referring to Fig. 6, another embodiment 

55 of the present invention will be explained below. Like ref- 
erence characters are used to indicate like parts in var- 
ious views including Fig. 6. 

[0097] As described before, in the servo control unit 
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52 (Figs. 1 to 5), NC program 42 reads and interprets 
the program reading and interpreting unit 44, the pro- 
gram execution command unit 48 draws the interpreted 
program temporarily stored in the interpreted program 
storing unit 46 then, the feed shaft motors M x , M Y and 
M z of the numerically controlled machine tool 1 0 shown 
in Fig. 1 are controlled according to the movement com- 
mand outputted from the movement command distrib- 
uting control unit 50. When acceleration and decelera- 
tion of the feed shaft motors are repeated in a short pe- 
riod, the feed shaft motor driving unit 54 and feed shaft 
motors M x , M Y and M 2 are heated. When the tempera- 
ture reaches the allowable upper limit, the thermal alarm 
is raised, so that the numerically controlled machine tool 
is stopped in emergency. 

[0098] Time constant of acceleration and decelera- 
tion of the feed shaft suitable for the numerically con- 
trolled machine tool 10, the relation between the torque 
command or electric current command, which is taken 
out from the servo control unit 52, and the temperature 
of each feed shaft motor M x , M Y , M z , temperature curve 
presenting changes in temperatures of feed shaft mo- 
tors M x , M Y , M 2 when the rated currents are continu- 
ously supplied to feed shaft motors M x , M Y , M z , and re- 
lations between the inclinations Q of the temperature 
curves and the time constants of acceleration and de- 
celeration of the feed shafts are previously determined 
by experiments and stored in the data storing unit 110. 
Further, parameters presenting the sizes of the feed 
shaft motors M x , M Y , M z and the feed shaft motor driving 
unit 54 are also stored in the data storing unit 110. The 
temperature calculating unit 112 calculates and esti- 
mates temperatures of the drive means such as feed 
shaft motors M x , M Y , M z every moment by collating the 
torque command or electric current command taken out 
from the servo control unit 52 with the relations between 
the torque command or electric current command and 
the temperatures of feed shaft motors M)<, M Y , M z . 
[0099] The acceleration and deceleration time con- 
stant calculating unit 114 receives a result of calculation 
sent from the temperature calculating unit 112, and cal- 
culates an acceleration and deceleration time constant 
of the feed shaft of every moment based on the relation 
between the inclination of the temperature curve (not 
shown) and the acceleration and deceleration time con- 
stant stored in the data storing unit 1 1 0, and outputs ac- 
celeration and deceleration time constant of the feed 
shaft. The acceleration and deceleration time constant 
commanding unit 116 gives a command of the acceler- 
ation and deceleration time constant of the feed shaft of 
every moment from the acceleration and deceleration 
time constant calculating unit 114 to the movement com- 
mand distribution control unit 50 just in time with the 
progress of operation of the numerically controlled ma- 
chine tool 10. In this connection, at the initiation of con- 
trol, predetermined acceleration and deceleration time 
constant TO of the feed shaft is directly sent to the move- 
ment command distribution control unit 50 from the data 



storing unit 110. 

[0100] Next, referring to Fig. 10, operation of this em- 
bodiment will be explained below. 
[0101] First, necessary data are set in the data storing 

5 unit 110 (step S50). As described above, the necessary 
data are: the acceleration and deceleration time con- 
stant of the feed shaft suitable for the numerically con- 
trolled machine tool 1 0; the relations between the torque 
command or electric current command from the servo 

10 control unit 52 and the temperatures of each feed shaft 
motors M x , M Y , M z ; the temperature curves (not shown) 
presenting changes in the temperatures of the feed 
shaft motors M x , M Y , M z when the rated currents are 
continuously supplied to feed shaft motors M x , M Y , M 2 ; 

*5 the relations between the inclinations of the temperature 
curves and the acceleration and deceleration time con- 
stant of the feed shafts; and the parameters presenting 
the sizes of feed shaft motors M x , M Y , M z and driving 
unit 54. These are previously determined by experi- 

20 ments and stored during the manufacture of the numer- 
ically controlled machine tool 10. When the numerically 
controlled machine tool 10 is operated according to NC 
program 42, the torque command or electric current 
command is successively put into the temperature cal- 

25 culating unit 112 (step S112) from the servo control unit 
52. 

[0102] The temperature calculating unit 112 collates 
the torque command or electric current command with 
the relation between the torque command or electric 

30 current command and the temperature of the drive 
means of feed motors M x , M Y , M z stored in the data 
storing unit 110 to calculate and estimate the tempera- 
ture of the drive means at every moment, and makes 
the temperature curve of the drive means with respect 

35 to the lapse of time, for example, the temperature curves 
(1 ) and (2) shown in Fig. 11 (step S54). The acceleration 
and deceleration time constant calculating unit 114 com- 
pares the instantaneous inclination 9 of the temperature 
curve with the inclination 0 O at the same temperature 

40 (temperature MT1 in Fig. 11), of the temperature curve 
for the rated current which previously set in step S50, 
(step S56). In the case of temperature curve (1), the in- 
stantaneous inclination 0 is 6 1f and in the case of tem- 
perature curve (2), the instantaneous inclination e is e 2 . 

45 The result of comparison is applied to the relation be- 
tween inclination 9 of the temperature curve shown in 
Fig. 12 and acceleration and deceleration time constant 
T of the feed shaft. 

[0103] If 9 > 9 0 (when the result is "Yes" in step S58, 
so such as 9 = 9^, an acceleration and deceleration time 
constant higher than TO is calculated based on the re- 
lation shown in Fig. 12 (step S60) and outputted into the 
movement command distribution control unit 50 via the 
acceleration and deceleration time constant command 
55 unit 116 (step S62). If of 9 < 9 0 (when the result is "No" 
in step S52, such as 9 = 0 2 ), acceleration and deceler- 
ation constant TO of the feed shaft, which is previously 
set in step S50, is sent as it is to the movement com- 
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mand distribution control unit 50 via the acceleration and 
deceleration time constant command unit 116 (step 
S64). 

[0104] In Fig. 12, acceleration and deceleration time 
constant T of the feed shaft has upper limit Tmax, which 
does not allow overheat of the drive means even if ac- 
celeration and deceleration are continuously repeated. 
There exists a minimum inclination 6P of the tempera- 
ture curve which corresponds to Tmax. That is, in a 
range in which 6 is higher than 8P, T is Tmax. In this 
connection, the temperature curve of the drive means 
is not limited to that shown in Fig. 11. The temperature 
curve of the drive means may be expressed in the form 
of a table in which the relation between the time and 
inclination 0 is expressed by a predetermined time pe- 
riod. The present embodiment includes a method in 
which the temperatures of the feed shaft motors are cal- 
culated and estimated by the number of times of accel- 
erations and decelerations of the feed shafts, or the tem- 
peratures of the feed shaft motors are actually detected 
by temperature detecting sensors, to accelerate and de- 
celerate the feed shafts based on the result of compar- 
ison of the temperatures thus obtained with the allowa- 
ble temperature. 

[0105] The preferred embodiments of the present in- 
vention are explained above. However, it should be not- 
ed that the present invention is not limited to the above 
specific embodiments, and variations and modifications 
may be made by one skilled in the art without departing 
from the spirit and scope of the present invention. 
[0106] For example, in the embodiment described 
above, so called backlash acceleration correcting con- 
trol in Figs. 2 and 3, inertia correcting control in Figs. 4 
and 5, and acceleration and deceleration control of the 
feed shaft motors in Fig. 6 are described separately. 
However, advantageously combining the above various 
types of control are appropriately with each other will 
provide a highly efficientive and accurate machining 
process. 

[0107] In the above description, the numerically con- 
trolled machine tool of the present invention is a hori- 
zontal type machining center having three orthogonal 
axes of X, Y and Z-axis as shown in Fig. 1 . However, it 
should be noted that the present invention is not limited 
to the above specific machine. For example, in addition 
to the three axes of X-, Y- and Z-axis, it is possible to 
provide the two axes of A- and B-axis by which the table 
14 can be turned round a horizontal axis, that is, the 
present invention may be applied to the five axis type 
numerically controlled machine tool. Further, the 
present invention may be applied to the four axis type 
numerically controlled machine tool having the four axes 
of X-, Y-, Z- and A-axis, or alternatively the present in- 
vention may be applied to the four axis type numerically 
controlled machine tool having the four axes of X-, Y-, 
Z- and B-axis, and furthermore the present invention 
may be applied to the numerically controlled machine, 
the number of axes of which is not less than six. Fur- 



thermore, the present invention can be applied to not 
only the horizontal type machining center shown in Fig. 
1 but also vertical type machining centers and other nu- 
merically controlled machine tools such as a milling ma- 

5 chine. Furthermore, the present invention can be ap- 
plied to electric discharge diesinking machines having 
the three axes of X-, Y- and Z-axis. Also, the present 
invention can be applied to the wire electrical discharge 
machine having the four axes of X-, Y-, U- and V-axis. 

10 [0108] The calculation control unit 56, detecting unit 
66, acceleration calculating unit 68, load torque calcu- 
lating unit 70, static friction correcting unit 80, inertia cal- 
culating unit 96 and inertia storing unit 98 are compo- 
nents which are functionally independent from the nu- 

15 merically control unit 40. Therefore, these components 
may be housed in the common casing with the numeri- 
cally control unit 40. Alternatively, these components 
may be housed in a casing of the machine control unit 
which is arranged separately from the casing for the nu- 

20 merically control unit 40. 



Claims 

25 1 . A method of controlling a numerically controlled ma- 
chine tool having a plurality of feed shafts of three 
orthogonal X-, Y-, and Z-axes of X or at least one of 
rotary shafts of A-, B- and C-axes in addition to a 
plurality of feed shafts of three orthogonal X-, Y-, 

30 and Z-axes, characterized in that the method 
comprises the steps of: 

taking numerical controlling program data from 
a reading and interpreting unit provided in a nu- 

35 merically controlling device to execute the pro- 

gram data in a movement command distribu- 
tion controlling unit and a servo control unit; 
estimating an appropriate torque or electric cur- 
rent command corresponding to the changes in 

40 frictional force in the feed mechanisms of the 

respective feed shafts or in the weight of a 
workpiece based on the results of execution of 
the numerically controlling program data out- 
putted from the servo control unit; 

45 outputting the estimated appropriate torque or 

electric current command to motor drive means 
of the feed shafts; and 

driving feed motors by the appropriate torque 
or electric current command corresponding to 
so the changes in frictional force in the feed mech- 

anisms of the respective feed shafts or in the 
weight of a workpiece. 

2. Amethod of controlling a numerically controlled ma- 
ss chine tool including the steps of taking numerical 
controlling program data from a reading and inter- 
preting unit provided in a numerically controlling de- 
vice to execute the program data in a movement 
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command distribution controlling unit and a servo 
control unit; and outputting the execution to motor 
drive means of the feed shafts through feed shaft 
motor driving means to move a moving body by a 
feed mechanism, characterized in that the method 5 
comprises the steps of: 

calculating a torque or electric current com- 
mand, based on a moving command value out- 
putted from the movement command distribu- 10 
tion controlling unit, in the servo control unit to 
output to the feed motor driving means to drive 
the feed motor; 

taking the torque or electric current command 
outputted from the servo motor control unit to 15 
the feed shaft motor driving means; 
estimating a desired torque or electric current 
command corresponding to the changes in fric- 
tional force in the feed mechanisms of the re- 
spective feed shafts or in the weight of a work- 20 
piece based on the results of execution of the 
numerically controlling program data outputted 
from the servo control unit; 
outputting the estimated desired torque or elec- 
tric current command to motor drive means of 25 
the feed shafts; and 

driving feed motors by the desired torque or 
electric current command. 

A method of controlling a numerically controlled ma- 30 
chine tool according to claim 2, characterized in 
that the estimation of the desired torque or electric 
current command corresponding to the changes in 
frictional force in the feed mechanisms or in the 
weight of a workpiece is an estimation of a torque 35 
or electric current command corresponding to the 
changes in frictional force in the feed mechanisms 
or in the weight of a workpiece based on the torque 
or electric current command and the acceleration of 
the feed shaft, which have been taken. 40 

A method of controlling a numerically controlled ma- 
chine tool including the steps of taking numerical 
controlling program data from a reading and inter- 
preting unit provided in a numerically controlling de- 45 
vice to execute the program data in a movement 
command distribution controlling unit and a servo 
control unit; and outputting the execution to motor 
drive means of the feed shafts through feed shaft 
motor driving means to move a moving body by a so 
feed mechanism, characterized in that the method 
comprises the steps of: 

calculating a torque or electric current com- 
mand, based on a moving command value out- 55 
putted from the movement command distribu- 
tion controlling unit, in the servo control unit to 
output to the feed motor driving means to drive 



the feed motor; 

detecting an inversion of the direction of move- 
ment of the feed shaft; 

calculating the acceleration of the feed shaft at 
the time when he inversion of the direction of 
movement of the feed shaft is detected; 
calculating the load torque based on the torque 
electric current command outputted from the 
servo control unit at the time when the inversion 
of the direction of movement of the feed shaft 
is detected to set it as the load torque before 
the inversion of the direction of movement of 
the feed shaft; 

inverting the sign of value of the toad torque 
and multiplying the load torque before the in- 
version of the direction of movement of the feed 
shaft by a predetermined constant to set the 
product as a target value for the load torque for 
the operation after the inversion of the direction 
of movement of the feed shaft; 
calculating a load torque for the operation after 
the direction of movement of the feed shaft is 
inverted, between the time of the detection of 
the inversion of the direction of movement of 
the feed shaft and the time when the load 
torque reaches the target value, by using a time 
constant expressed as a function of accelera- 
tion at the time of the inversion of the direction 
of the feed shaft; 

calculating a desired torque or electric current 
command based on the load torque after the 
direction of movement of the feed shaft is in- 
verted; 

outputting the desired torque or electric current 
command to motor drive means of the feed 
shafts; and 

moving the moving body by the feed shaft mo- 
tor and the feed mechanism. 

5. A method of controlling a numerically controlled ma- 
chine tool according to claim 4, wherein the load 
torque after the inversion of the direction of move- 
ment of the feed shaft is calculated by using a time 
constant which is in inverse proportion to square 
root of the acceleration at the time when the inver- 
sion of the direction of movement of the feed shaft 
is detected. 

6. A method of controlling a numerically controlled ma- 
chine tool according to claim 4, wherein the load 
torque after the inversion of the direction of move- 
ment of the feed shaft is calculated by using a plu- 
rality of time constants which are in inverse propor- 
tion to square root of the acceleration at the time 
when the inversion of the direction of movement of 
the feed shaft is detected. 

7. A method of controlling a numerically controlled ma- 
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chine tool according to claim 4, wherein the calcu- 
lation of the load torque after the inversion of the 
direction of movement of the feed shaft is terminat- 
ed by a ratio until the set point of load torque reach- 
es or by a distance from the feed shaft when an in- 5 
version of the direction of movement of the feed 
shaft is detected. 



8. A method of controlling a numerically controlled ma- 
chine tool including the steps of taking numerical 10 
controlling program data from a reading and inter- 
preting unit provided in a numerically controlling de- 
vice to execute the program data in a movement 
command distribution controlling unit and a servo 
control unit; and outputting the execution to motor 1$ 
drive means of the feed shafts through feed shaft 
motor driving means to move a moving body by a 
feed mechanism, characterised in that the method 
comprises the steps of: 

20 

setting previously a desired torque command 
and a speed command or a desired electric cur- 
rent command and a speed command, depend- 
ing on the static frictional force in the feed 
mechanism; 25 
calculating a torque or electric current com- 
mand, based on a moving command value out- 
putted from the movement command distribu- 
tion controlling unit, in the servo control unit to 
output to the feed motor driving means to drive 30 
the feed motor; 

detecting an inversion of the direction of move- 
ment of the feed shaft or an initiation of move- 
ment of the stationary feed shaft; 
outputting, when the inversion of the direction 35 
of movement of the feed shaft or the initiation 
of movement of the stationary feed shaft is de- 
tected, the desired torque command and the 
speed command or the desired electric current 
command and the speed command, which are *o 
previously set, to the feed shaft motor driving 
means and servo control means; and 
moving the moving body by the feed shaft mo- 
tor and feed mechanism. 

45 

9. A method of controlling a numerically controlled ma- 
chine tool including the steps of taking numerical 
controlling program data from a reading and inter- 
preting unit provided in a numerically controlling de- 
vice to execute the program data in a movement 50 
command distribution controlling unit and a servo 
control unit; and outputting the execution to motor 
drive means of the feed shafts through feed shaft 
motor driving means to move a moving body by a 
feed mechanism, characterized in that the method 55 
comprises the steps of: 

setting previously a desired torque command 
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and a speed command or a desired electric cur- 
rent command and a speed command, depend- 
ing on the static frictional force in the feed 
mechanism; 

calculating a torque or electric current com- 
mand, based on a moving command value out- 
putted from the movement command distribu- 
tion controlling unit, in the servo control unit to 
output to the feed motor driving means to drive 
the feed motor; 

detecting an inversion of the direction of move- 
ment of the feed shaft or an initiation of move- 
ment of the stationary feed shaft; 
calculating the acceleration of the feed shaft at 
the time when he inversion of the direction of 
movement of the feed shaft is detected; 
calculating the load torque based on the torque 
electric current command outputted from the 
servo control unit at the time when the inversion 
of the direction of movement of the feed shaft 
is detected to set it as the load torque before 
the inversion of the direction of movement of 
the feed shaft; 

inverting the sign of value of the toad torque 
and multiplying the load torque before the in- 
version of the direction of movement of the feed 
shaft by a predetermined constant to set the 
product as a target value for the load torque for 
the operation after the inversion of the direction 
of movement of the feed shaft; 
calculating a load torque for the operation after 
the direction of movement of the feed shaft is 
inverted, between the time of the detection of 
the inversion of the direction of movement of 
the feed shaft and the time when the load 
torque reaches the target value, by using a time 
constant expressed as a function of accelera- 
tion at the time of the inversion of the direction 
of the feed shaft; 

calculating a desired torque or electric current 
command based on the load torque after the 
direction of movement of the feed shaft is in- 
verted; 

outputting the desired torque or electric current 
command to motor drive means; 
outputting, when the inversion of the direction 
of movement of the feed shaft or the initiation 
of movement of the stationary feed shaft is de- 
tected, the desired torque command and the 
speed command or the desired electric current 
command and the speed command, which are 
previously set, to the feed shaft motor driving 
means and servo control means; and 
moving the moving body by the feed shaft mo- 
tor and feed mechanism. 

10. A method of controlling a numerically controlled ma- 
chine tool including the steps of taking numerical 
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controlling program data from a reading and inter- 
preting unit provided in a numerically controlling de- 
vice to execute the program data in a movement 
command distribution controlling unit and a servo 
control unit; and outputting the execution to motor 
drive means of the feed shafts through feed shaft 
motor driving means to move a moving body by a 
feed mechanism, characterized in that the method 
comprises the steps of: 

calculating a torque or electric current com- 
mand, based on a moving command value out- 
putted from the movement command distribu- 
tion controlling unit, in the servo control unit to 
output to the feed motor driving means to drive 
the feed motor; 

taking the torque or electric current command 
outputted to the feed shaft motor drive means 
through the servo control unit as a torque or 
electric current command for the moving feed 
shaft; 

calculating a load inertia based on the torque 
or electric current command for the moving 
feed shaft and the acceleration in the feed 
shaft; 

calculating a desired torque or electric current 
command corresponding to the calculated load 
inertia; 

outputting the desired torque or electric current 
command to the feed motor shaft motor drive 
means; and 

moving the moving body by the feed shaft mo- 
tor and the feed mechanism. 

1 1. A method of controlling a numerically controlled ma- 
chine tool including the steps of taking numerical 
controlling program data from a reading and inter- 
preting unit provided in a numerically controlling de- 
vice to execute the program data in a movement 
command distribution controlling unit and a servo 
control unit; and outputting the execution to motor 
drive means of the feed shafts through feed shaft 
motor driving means to move a moving body by a 
feed mechanism, characterized in that the method 
comprises the steps of: 

calculating a torque or electric current com- 
mand, based on a moving command value out- 
putted from the movement command distribu- 
tion controlling unit, in the servo control unit to 
output to the feed motor driving means to drive 
the feed motor; 

detecting the weight of a workpiece or a moving 
body to which the workpiece is mounted; 
calculating a load inertia based on the detected 
weight; 

calculating a desired torque or electric current 
command based on the calculated load inertia; 



outputting the desired torque or electric current 
command to the speed shaft motor drive 
means; and 

moving the moving body by the feed shaft mo- 
5 tor and the feed mechanism. 

12. A method of controlling a numerically controlled ma- 
chine tool including the steps of taking numerical 
controlling program data from a reading and inter- 
na preting unit provided in a numerically controlling de- 
vice to execute the program data in a movement 
command distribution controlling unit and a servo 
control unit; and outputting the execution to motor 
drive means of the feed shafts through feed shaft 

15 motor driving means to move a moving body by a 
feed mechanism, characterized in that the method 
comprises the steps of: 

calculating a torque or electric current com- 
20 mand, based on a moving command value out- 

putted from the movement command distribu- 
tion controlling unit, in the servo control unit to 
output to the feed motor driving means to drive 
the feed motor; 
25 setting and storing a time constant of acceler- 

ation and deceleration of the feed shaft and al- 
lowable temperature data for feed shaft motor; 
taking the torque or electric current command 
outputted from the servo control unit to the feed 
30 motor driving means; 

estimating the temperature of the feed shaft 
motor based on the taken torque or electric cur- 
rent command; 

comparing the previously stored allowable tem- 
35 perature data and the estimated temperature of 

the feed shaft motor; 

calculating an acceleration deceleration time 
constant based on the comparison results; 
estimating a desired torque command or an 

40 electric current command corresponding to a 

change in the frictional force of the feed mech- 
anism or the weight of a workpiece obtained 
based on the torque command or the electric 
current command and the acceleration of the 

45 feed shaft outputted from the servo control unit 

to the feed shaft motor drive means; 
outputting the estimated desired torque or elec- 
tric current command to the feed motor drive 
means; and 

so moving the moving body by the feed shaft mo- 

tor and the feed mechanism. 

13. A numerically controlled machine tool having a plu- 
rality of feed shafts of three orthogonal X-, Y-, and 

55 Z-axes or at least one of rotary shafts of A-, B- and 
C-axes in addition to a plurality of feed shafts of 
three orthogonal X-, Y-, and Z-axes of X, charac- 
terized in that the numerically controlled machine 
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tool comprises: 

a feed mechanism for moving a moving body 
of each feed shaft; 

a feed shaft motor for driving the feed mecha- 5 
nism; 

a feed shaft motor drive means for driving the 
feed shaft motor; 

a numerically controlling means for executing 
the numerically controlled program data to 10 
drive the feed shaft motor by a moving com- 
mand distribution controlling unit and a servo 
control unit and for outputting the result of ex- 
ecution to the feed shaft motor through the feed 
shaft motor drive means; 15 
a calculation controlling means for estimating a 
desired torque command or an electric current 
command corresponding to a change in the fric- 
tional force of the feed mechanism or the weight 
of a workpiece obtained based on the torque 20 
command or the electric current command and 
the acceleration of the feed shaft outputted 
from the servo control unit to the feed shaft mo- 
tor drive means when the feed shaft motor is 
driven to output the estimated desired torque 25 
or electric current command to the feed motor 
drive means. 

14. A numerically controlled machine tool including a 
numerically controlling device which has a reading 30 
an interpreting unit, a movement command distri- 
bution controlling unit for executing a numerical 
control program data, which has been drawn from 
the reading an interpreting unit, the result of execu- 
tion being outputted to a feed shaft motor of a feed 35 
shaft through a feed shaft motor drive means to 
move a moving body by a feed mechanism, char- 
acterized in that the numerically controlled ma- 
chine tool comprises: 

40 

a feed mechanism for moving a moving body 
of each feed shaft; 

a feed shaft motor for driving the feed mecha- 
nism; 

a feed shaft motor drive means for driving the 45 
feed shaft motor; 

a numerically controlling means for executing 
the numerically controlled program data to 
drive the feed shaft motor by a moving com- 
mand distribution controlling unit and a servo 50 
control unit and for outputting the result of ex- 
ecution to the feed shaft motor through the feed 
shaft motor drive means; 
a calculation controlling means for estimating a 
desired torque command or an electric current 55 
command corresponding to a change in the fric- 
tional force of the feed mechanism or the weight 
of a workpiece obtained based on the torque 
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command or the electric current command and 
the acceleration of the feed shaft outputted 
from the servo control unit to the feed shaft mo- 
tor drive means when the feed shaft motor is 
driven to output the estimated desired torque 
or electric current command to the feed motor 
drive means. 

15. A numerically controlled machine tool including a 
numerically controlling device which has a reading 
an interpreting unit, a movement command distri- 
bution controlling unit for executing a numerical 
control program data, which has been drawn from 
the reading an interpreting unit, the result of execu- 
tion being outputted to a feed shaft motor of a feed 
shaft through a feed shaft motor drive means to 
move a moving body by a feed mechanism, char- 
acterized in that the numerically controlled ma- 
chine tool comprises: 

a position control means for calculating a speed 
command based on a movement command of 
the feed shaft outputted from the movement 
command distribution controlling means; 
a speed control means for calculating a torque 
command or an electric current command 
based on the speed command of the feed shaft 
outputted from the position control means; 
a feed shaft motor drive means for outputting 
an electric current to drive the feed shaft motor 
according to the torque command of the feed 
shaft or the electric current command outputted 
from the speed control means; 
a detecting means for detecting an inversion of 
the direction of movement of the feed shaft; 
an acceleration calculating means for calculat- 
ing an acceleration when an inversion of the di- 
rection of movement of feed shaft by the detect- 
ing means; and 

a load torque calculating means for calculating 
a load torque after the inversion of the direction 
of movement of the feed shaft by using a time 
constant expressed by a function of the toque 
command or the electric current command out- 
putted from the speed control means at the time 
when the inversion of the direction of move- 
ment of the feed shaft is detected by the detect- 
ing means and the acceleration, calculated by 
the acceleration calculating means, when the 
inversion of the direction of movement of the 
feed shaft is detected to output the calculated 
desired torque or electric current command cor- 
responding to the load torque to the speed con- 
trol means. 

16. A numerically controlled machine tool including a 
numerically controlling device which has a reading 
an interpreting unit, a movement command distri- 
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bution controlling unit for executing a numerical 
control program data, which has been drawn from 
the reading an interpreting unit, the result of execu- 
tion being outputted to a feed shaft motor of a feed 
shaft through a feed shaft motor drive means to 5 
move a moving body by a feed mechanism, char- 
acterized in that the numerically controlled ma- 
chine tool comprises: 

a position control means for calculating a speed io 
command based on a movement command of 
the feed shaft outputted from the movement 
command distribution controlling means; 
a speed control means for calculating a torque 
command or an electric current command 15 
based on the speed command of the feed shaft 
outputted from the position control means; 
a feed shaft motor drive means for outputting 
an electric current to drive the feed shaft motor 
according to the torque command of the feed 20 
shaft or the electric current command outputted 
from the speed control means; 
a detecting means for detecting an inversion of 
the direction of movement of the feed shaft or 
the initiation of movement of the stationary feed 25 
shaft; and 

a static friction correcting means for outputting 
predetermined desired torque command and 
speed command or electric current command 
and speed command, to the feed shaft motor 30 
drive means and the speed control means, cor- 
responding to the static frictional force of the 
feed mechanism when the inversion of the di- 
rection of movement of the feed shaft or the in- 
itiation of the movement of the feed shaft is de- 35 
tected by the detecting means. 

17. A numerically controlled machine tool including a 
numerically controlling device which has a reading 
an interpreting unit, a movement command distri- 40 
bution controlling unit for executing a numerical 
control program data, which has been drawn from 
the reading an interpreting unit, the result of execu- 
tion being outputted to a feed shaft motor of a feed 
shaft through a feed shaft motor drive means to 45 
move a moving body by a feed mechanism, char- 
acterized in that the numerically controlled ma- 
chine tool comprises: 

a position control means for calculating a speed so 
command based on a movement command of 
the feed shaft outputted from the movement 
command distribution controlling means; 
a speed control means for calculating a torque 
command or an electric current command 55 
based on the speed command of the feed shaft 
outputted from the position control means; 
a feed shaft motor drive means for outputting 
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an electric current to drive the feed shaft motor 
according to the torque command of the feed 
shaft or the electric current command outputted 
from the speed control means; 
a detecting means for detecting an inversion of 
the direction of movement of the feed shaft or 
the initiation of movement of the stationary feed 
shaft; and 

an acceleration calculating means for calculat- 
ing the acceleration when the detecting means 
detects the inversion of the direction of move- 
ment of the feed shaft; 

a load torque calculating means for calculating 
a load torque after the inversion of the direction 
of movement of the feed shaft by using a time 
constant expressed by a function of the toque 
command or the electric current command out- 
putted from the speed control means at the time 
when the inversion of the direction of move- 
ment of the feed shaft is detected by the detect- 
ing means and the acceleration, calculated by 
the acceleration calculating means, when the 
inversion of the direction of movement of the 
feed shaft is detected to output the calculated 
desired torque or electric current command cor- 
responding to the load torque to the speed con- 
trol means; 

a static friction correcting means for outputting 
predetermined desired torque command and 
speed command or electric current command 
and speed command, to the feed shaft motor 
drive means and the speed control means, cor- 
responding to the static frictional force of the 
feed mechanism when the inversion of the di- 
rection of movement of the feed shaft or the in- 
itiation of the movement of the feed shaft is de- 
tected by the detecting means. 

18. A numerically controlled machine tool including a 
numerically controlling device which has a reading 
an interpreting unit, a movement command distri- 
bution controlling unit for executing a numerical 
control program data, which has been drawn from 
the reading an interpreting unit, the result of execu- 
tion being outputted to a feed shaft motor of a feed 
shaft through a feed shaft motor drive means to 
move a moving body by a feed mechanism, char- 
acterized in that the numerically controlled ma- 
chine tool comprises: 

a position control means for calculating a speed 
command based on a movement command of 
the feed shaft outputted from the movement 
command distribution controlling means; 
a speed control means for calculating a torque 
command or an electric current command 
based on the speed command of the feed shaft 
outputted from the position control means; 
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a feed shaft motor drive means for outputting 
an electric current to drive the feed shaft motor 
according to the torque command of the feed 
shaft or the electric current command outputted 
from the speed control means; 
a speed feedforward control means for estimat- 
ing a speed command based on the movement 
command of the feed shaft outputted from the 
movement command distribution controlling 
unit by calculation to output the speed com- 
mand to the speed control means; 
an acceleration feedforward control means for 
estimating an acceleration or torque command 
of the feed shaft outputted from the movement 
command distribution controlling unit by calcu- 
lation to output the acceleration or torque com- 
mand to the feed shaft motor drive means; and 
an inertia calculating means for calculating a 
load inertia based on the torque or electric cur- 
rent command, outputted to the feed shaft mo- 
tor drive means from the speed control means, 
and the acceleration of the feed shaft to output 
the load inertia to the speed control means and 
the acceleration feed forward control means, 
the speed control means outputs a desired 
torque or electric current command based n the 
load inertia, calculated by the inertia calculating 
means, to the speed shaft motor drive means. 

19. A numerically controlled machine tool including a 
numerically controlling device which has a reading 
an interpreting unit, a movement command distri- 
bution controlling unit for executing a numerical 
control program data, which has been drawn from 
the reading an interpreting unit, the result of execu- 
tion being outputted to a feed shaft motor of a feed 
shaft through a feed shaft motor drive means to 
move a moving body by a feed mechanism, char- 
acterized in that the numerically controlled ma- 
chine tool comprises: 

a position control means for calculating a speed 
command based on a movement command of 
the feed shaft outputted from the movement 
command distribution controlling means; 
a speed control means for calculating a torque 
command or an electric current command 
based on the speed command of the feed shaft 
outputted from the position control means; 
a feed shaft motor drive means for outputting 
an electric current to drive the feed shaft motor 
according to the torque command of the feed 
shaft or the electric current command outputted 
from the speed control means; 
a speed feedforward control means for estimat- 
ing a speed command based on the movement 
command of the feed shaft outputted from the 
movement command distribution controlling 
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unit by calculation to output the speed com- 
mand to the speed control means; 
an acceleration feedforward control means for 
estimating an acceleration or torque command 
of the feed shaft outputted from the movement 
command distribution controlling unit by calcu- 
lation to output the acceleration or torque com- 
mand to the feed shaft motor drive means; 
a weight detecting means for detecting the 
weight of a workpiece or a moving body to 
which the workpiece is mounted; and 
an inertia calculating means for calculating a 
load inertia based on the torque or electric cur- 
rent command, outputted to the feed shaft mo- 
tor drive means from the speed control means, 
and the acceleration of the feed shaft to output 
the load inertia to the speed control means and 
the acceleration feed forward control means, 
the speed control means outputting a desired 
torque or electric current command based on 
the load inertia, calculated by the inertia calcu- 
lating means, to the speed shaft motor drive 
means. 

20. A feed mechanism for moving a moving body of 
each feed shaft; 

a feed shaft motor for driving the feed mecha- 
nism; 

a feed shaft motor drive means for driving the 
feed shaft motor; 

a numerically controlling means for executing 
the numerically controlled program data to 
drive the feed shaft motor by a moving com- 
mand distribution controlling unit and a servo 
control unit and for outputting the result of ex- 
ecution to the feed shaft motor through the feed 
shaft motor drive means; 
a data storage means for storing a time con- 
stant of acceleration and deceleration of the 
feed shaft and allowable temperature data for 
feed shaft motor; 

a temperature calculating means for estimat- 
ing, through an calculation, the temperature of 
the feed shaft motor based on the torque or 
electric current command outputted to the feed 
shaft motor drive means from the servo motor 
control means; 

an acceleration deceleration time constant cal- 
culating means for setting an acceleration de- 
celeration time constant based on a compari- 
son between the allowable temperature data 
previously stored in the data storing means and 
the temperature of the feed shaft motor estimat- 
ed by the temperature calculating means to out- 
put the resultant time constant to the movement 
command distribution controlling unit; and 
a calculation controlling means for estimating a 
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desired torque command or an electric current 
command corresponding to a change in the f ric- 
tional force of the feed mechanism or the weight 
of a workpiece obtained based on the torque 
command or the electric current command and 5 
the acceleration of the feed shaft outputted 
from the servo control unit to the feed shaft mo- 
tor drive means when the feed shaft motor is 
driven to output the estimated desired torque 
or electric current command to the feed motor 10 
drive means. 
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Fig.9B 
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CALCULATION OF MEAN VALUE OF TORQUE 
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CONSTANT SPEED CONDITION 
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TORQUE UNDER CONSTANT SPEED CONDITION 
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DESCRIPTION OP THE REFERENCE NUMERALS 



10 


Numerically controlled machine tool 


12 


Bed 


14 


Table 


16 


Column 


18 


Spindle head 


20 


Spindle 


22 


Tool 


24 


Feed screw of z-axis 


26 


NUt 


28 


Guide rail of Z-axis 


30 


Nut 


32 


Feed screw of Y-axis 


34 


Guide rail of Y-axis 


36 


Guide rail of X-axis 


40 


Numerically control unit 


42 


NC program 


44 


Program reading interpreting unit 


46 


Interpreted program storing unit 


48 


Program execution command unit 


50 


Movement command distribution control unit 


52 


Servo control unit 


54 


Feed shaft motor drive unit 


56 


Calculation control unit 


58 


Subtracter 


60 


Position control unit 


62 


Subtracter 
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64 Speed control unit 

64a Speed loop gain 

64b Inertia 

66 Detecting unit 

68 Acceleration calculating unit 

70 Load torque calculating unit 

72 Time constant calculating unit 

74 Load torque correction calculating unit 

76 Load torque detecting unit 

80 Static friction correcting unit 

82 Speed correction value 

84 Torque correction value 

90 Speed feedforward control unit 

92 Acceleration feedforward control unit 

94 Subtracter 

96 Inertia calculating unit 

98 Inertia storing unit 

100 Weight detecting unit 

110 Data storing unit 

112 Temperature calculating unit 

114 Acceleration and deceleration time constant calculating 
unit 

116 Acceleration and deceleration time constant command unit 
w Workpiece 

Mx X-axis feed servo motor 

My Y-axis feed servo motor 

Mz Z-axis feed servo motor 

PC Pulse coder 

SP Position detector 



EP1 143 316 A1 



INTERNATIONAL SEARCH REPORT 



Internationa] application No. 

PCT/JP99/G5aO-l 



A. CLASSIFICATION OF SUBJECT MATTER 

Int. CI 7 G05B19/404, B23Q15/22 



According to International Patent Classification (IPC) or to both national classification and IPC 



B. FIELDS SEARCHED 



Minimum documentation searched (classification system followed by classification symbols) 
Int. CI 7 G05B19/404, B23Q15/22 



Documentation searched other than minimum documentation to the extent that such documents are included in the fields searched 
Jitsuyo Shinan Kdho 1926-1998 Toroku Jitsuyo Shi nan Kbho 1994-1996 

Kokai Jitsuyo Shinan Xbho 1926-1998 Jitsuyo Shinan Toro)cu Koho 1996-1998 



Electronic dam base consulted during the international search (name of data base and, where practicable, search terms used) 



C DOCUMENTS CONSIDERED TO BE RELEVANT 



Citation of document, with indication, where appropriate, of the relevant passages 



Relevant to claim No. 



JP, 03-290706, A (Mitsubishi Electric Corporation), 

20 December, 1991 (20.12.91) , 

Claims 

& DE, 4111530, A 

JP, 02-12407, A (Okuraa Mach Works Ltd.), 
17 January, 1990 (17.01.90), 

page 2, lower left column, lines 5 to 16 (Family: none) 



JP, 08-249031, A (FANTJC LTD) , 
27 September, 1996 (27.09.96), 
page 3, left column, lines 25 to 32 



(Family: none) 



A 
A 



JP, 10-63339, A (Kabushiki Kaisha Mori Seki Seisakusho) , 
06 March, 1996 (06.03.98) (Family: none) 

JP, 10-63325, A (TOSHIBA MACHINE CO., LTD.), 
06 March, 1998 (06.03.98) 
& US, 5920169, A 

JP, 05-80824, A (Mitsubishi Electric Corporation), 
02 April, 1993 (02.04.93) (Family: none) 



1-3,10,11,13, 
14,18,19 



1-3,10,11,13, 
14,18,19 



1-3,10,11,13, 
14,19,19 



1-3,10,11,13, 
18,19 

4-9,15-17 



4-9,15-17 



Further documents are listed in the continuation of Box C Q See patent family annex. 



* Special categories of cited documents: 

"A" document defining the general itate of the «rt which is not 

considered to be of particular relevance 
•fi" esriier document but published on or after the irjternatocnal filing 

date 

document which may throw doubu on priority dajm(s) or which is 
cited to establish the publication date of another citation or other 
special reason (ss specified) 
"CT document referring to an oral disclosure, use, exhibition or other 



"P* document published prior lo the alternation*! filing date but hier 
than the priority date claimed 



T later document published after the teternational filing date or 
priority date and not in conflict with tteapplicathM but cited to 
understand the principle or theory underlying the invention 

"X" document of particular relevance; the claimed invention cannot be 
considered novel or cannot be considered to involve an inventive 
step when the document ia uucen atone 

"V document of particular relevance; the claimed invention cannot be 
considered to invoJvc m inventive step when the document ta 
combined with one or more other such documents, such 
combination being obvious to a person skilled in the art 

"&* document mem be r of the same patent family 



Date of the actual completion of the international search 
17 January, 2000 (17.01.00) 



Date of mailing of the international search report 
25 January, 2000 (25.01.00) 



Name and mailing address of the ISA/ 
Japanese Patent Office 

Facsimile No. 



Authorized officer 
Telephone No. 



Form PCT/IS A/210 (second sheet) (July 1992) 



EP 1 143 316 A1 



INTERNATIONAL SEARCH REPORT 



International application No. 



C (Continuation). DOCUMENTS CONSIDERED-TOBE RELEVANT" 



Category' 



Citation of document, with indication, where appropriate, ofrhe relevant passages 



Relevant to- claim No. 



JP, 09-179623, A (Makina Milling Mach Co. r Ltd.), 
11 July, 1997 (11.07.971, 

page 4, left column, lines 6 to (Family: none) 



12, 20 _ 



Form PCT/ISA/210 (continuation of second sheet) (July 1992) 



